Lines Matching refs:pkg
159 tb_cfg_request_find(struct tb_ctl *ctl, struct ctl_pkg *pkg) in tb_cfg_request_find() argument
164 mutex_lock(&pkg->ctl->request_queue_lock); in tb_cfg_request_find()
165 list_for_each_entry(req, &pkg->ctl->request_queue, list) { in tb_cfg_request_find()
167 if (req->match(req, pkg)) { in tb_cfg_request_find()
173 mutex_unlock(&pkg->ctl->request_queue_lock); in tb_cfg_request_find()
181 static int check_header(const struct ctl_pkg *pkg, u32 len, in check_header() argument
184 struct tb_cfg_header *header = pkg->buffer; in check_header()
187 if (WARN(len != pkg->frame.size, in check_header()
189 len, pkg->frame.size)) in check_header()
191 if (WARN(type != pkg->frame.eof, "wrong eof (expected %#x, got %#x)\n", in check_header()
192 type, pkg->frame.eof)) in check_header()
194 if (WARN(pkg->frame.sof, "wrong sof (expected 0x0, got %#x)\n", in check_header()
195 pkg->frame.sof)) in check_header()
233 struct cfg_error_pkg *pkg = response->buffer; in decode_error() local
236 res.response_route = tb_cfg_get_route(&pkg->header); in decode_error()
238 res.err = check_header(response, sizeof(*pkg), TB_CFG_PKG_ERROR, in decode_error()
239 tb_cfg_get_route(&pkg->header)); in decode_error()
243 if (pkg->zero1) in decode_error()
244 tb_ctl_warn(ctl, "pkg->zero1 is %#x\n", pkg->zero1); in decode_error()
245 if (pkg->zero2) in decode_error()
246 tb_ctl_warn(ctl, "pkg->zero2 is %#x\n", pkg->zero2); in decode_error()
247 if (pkg->zero3) in decode_error()
248 tb_ctl_warn(ctl, "pkg->zero3 is %#x\n", pkg->zero3); in decode_error()
251 res.tb_error = pkg->error; in decode_error()
252 res.response_port = pkg->port; in decode_error()
257 static struct tb_cfg_result parse_header(const struct ctl_pkg *pkg, u32 len, in parse_header() argument
260 struct tb_cfg_header *header = pkg->buffer; in parse_header()
263 if (pkg->frame.eof == TB_CFG_PKG_ERROR) in parse_header()
264 return decode_error(pkg); in parse_header()
268 res.err = check_header(pkg, len, type, route); in parse_header()
319 static void tb_ctl_pkg_free(struct ctl_pkg *pkg) in tb_ctl_pkg_free() argument
321 if (pkg) { in tb_ctl_pkg_free()
322 dma_pool_free(pkg->ctl->frame_pool, in tb_ctl_pkg_free()
323 pkg->buffer, pkg->frame.buffer_phy); in tb_ctl_pkg_free()
324 kfree(pkg); in tb_ctl_pkg_free()
330 struct ctl_pkg *pkg = kzalloc(sizeof(*pkg), GFP_KERNEL); in tb_ctl_pkg_alloc() local
331 if (!pkg) in tb_ctl_pkg_alloc()
333 pkg->ctl = ctl; in tb_ctl_pkg_alloc()
334 pkg->buffer = dma_pool_alloc(ctl->frame_pool, GFP_KERNEL, in tb_ctl_pkg_alloc()
335 &pkg->frame.buffer_phy); in tb_ctl_pkg_alloc()
336 if (!pkg->buffer) { in tb_ctl_pkg_alloc()
337 kfree(pkg); in tb_ctl_pkg_alloc()
340 return pkg; in tb_ctl_pkg_alloc()
349 struct ctl_pkg *pkg = container_of(frame, typeof(*pkg), frame); in tb_ctl_tx_callback() local
350 tb_ctl_pkg_free(pkg); in tb_ctl_tx_callback()
364 struct ctl_pkg *pkg; in tb_ctl_tx() local
374 pkg = tb_ctl_pkg_alloc(ctl); in tb_ctl_tx()
375 if (!pkg) in tb_ctl_tx()
377 pkg->frame.callback = tb_ctl_tx_callback; in tb_ctl_tx()
378 pkg->frame.size = len + 4; in tb_ctl_tx()
379 pkg->frame.sof = type; in tb_ctl_tx()
380 pkg->frame.eof = type; in tb_ctl_tx()
381 cpu_to_be32_array(pkg->buffer, data, len / 4); in tb_ctl_tx()
382 *(__be32 *) (pkg->buffer + len) = tb_crc(pkg->buffer, len); in tb_ctl_tx()
384 res = tb_ring_tx(ctl->tx, &pkg->frame); in tb_ctl_tx()
386 tb_ctl_pkg_free(pkg); in tb_ctl_tx()
394 struct ctl_pkg *pkg, size_t size) in tb_ctl_handle_event() argument
396 return ctl->callback(ctl->callback_data, type, pkg->buffer, size); in tb_ctl_handle_event()
399 static void tb_ctl_rx_submit(struct ctl_pkg *pkg) in tb_ctl_rx_submit() argument
401 tb_ring_rx(pkg->ctl->rx, &pkg->frame); /* in tb_ctl_rx_submit()
409 static int tb_async_error(const struct ctl_pkg *pkg) in tb_async_error() argument
411 const struct cfg_error_pkg *error = pkg->buffer; in tb_async_error()
413 if (pkg->frame.eof != TB_CFG_PKG_ERROR) in tb_async_error()
430 struct ctl_pkg *pkg = container_of(frame, typeof(*pkg), frame); in tb_ctl_rx_callback() local
441 tb_ctl_err(pkg->ctl, "RX: invalid size %#x, dropping packet\n", in tb_ctl_rx_callback()
447 crc32 = tb_crc(pkg->buffer, frame->size); in tb_ctl_rx_callback()
448 be32_to_cpu_array(pkg->buffer, pkg->buffer, frame->size / 4); in tb_ctl_rx_callback()
456 if (*(__be32 *)(pkg->buffer + frame->size) != crc32) { in tb_ctl_rx_callback()
457 tb_ctl_err(pkg->ctl, in tb_ctl_rx_callback()
461 if (tb_async_error(pkg)) { in tb_ctl_rx_callback()
462 tb_ctl_handle_event(pkg->ctl, frame->eof, in tb_ctl_rx_callback()
463 pkg, frame->size); in tb_ctl_rx_callback()
471 if (*(__be32 *)(pkg->buffer + frame->size) != crc32) { in tb_ctl_rx_callback()
472 tb_ctl_err(pkg->ctl, in tb_ctl_rx_callback()
478 if (tb_ctl_handle_event(pkg->ctl, frame->eof, pkg, frame->size)) in tb_ctl_rx_callback()
492 req = tb_cfg_request_find(pkg->ctl, pkg); in tb_ctl_rx_callback()
494 if (req->copy(req, pkg)) in tb_ctl_rx_callback()
500 tb_ctl_rx_submit(pkg); in tb_ctl_rx_callback()
751 struct cfg_error_pkg pkg = { in tb_cfg_ack_plug() local
760 return tb_ctl_tx(ctl, &pkg, sizeof(pkg), TB_CFG_PKG_ERROR); in tb_cfg_ack_plug()
764 const struct ctl_pkg *pkg) in tb_cfg_match() argument
766 u64 route = tb_cfg_get_route(pkg->buffer) & ~BIT_ULL(63); in tb_cfg_match()
768 if (pkg->frame.eof == TB_CFG_PKG_ERROR) in tb_cfg_match()
771 if (pkg->frame.eof != req->response_type) in tb_cfg_match()
775 if (pkg->frame.size != req->response_size) in tb_cfg_match()
778 if (pkg->frame.eof == TB_CFG_PKG_READ || in tb_cfg_match()
779 pkg->frame.eof == TB_CFG_PKG_WRITE) { in tb_cfg_match()
781 const struct cfg_read_pkg *res_hdr = pkg->buffer; in tb_cfg_match()
790 static bool tb_cfg_copy(struct tb_cfg_request *req, const struct ctl_pkg *pkg) in tb_cfg_copy() argument
795 res = parse_header(pkg, req->response_size, req->response_type, in tb_cfg_copy()
798 memcpy(req->response, pkg->buffer, req->response_size); in tb_cfg_copy()