Lines Matching refs:ctl
53 #define tb_ctl_WARN(ctl, format, arg...) \ argument
54 dev_WARN(&(ctl)->nhi->pdev->dev, format, ## arg)
56 #define tb_ctl_err(ctl, format, arg...) \ argument
57 dev_err(&(ctl)->nhi->pdev->dev, format, ## arg)
59 #define tb_ctl_warn(ctl, format, arg...) \ argument
60 dev_warn(&(ctl)->nhi->pdev->dev, format, ## arg)
62 #define tb_ctl_info(ctl, format, arg...) \ argument
63 dev_info(&(ctl)->nhi->pdev->dev, format, ## arg)
65 #define tb_ctl_dbg(ctl, format, arg...) \ argument
66 dev_dbg(&(ctl)->nhi->pdev->dev, format, ## arg)
123 static int tb_cfg_request_enqueue(struct tb_ctl *ctl, in tb_cfg_request_enqueue() argument
127 WARN_ON(req->ctl); in tb_cfg_request_enqueue()
129 mutex_lock(&ctl->request_queue_lock); in tb_cfg_request_enqueue()
130 if (!ctl->running) { in tb_cfg_request_enqueue()
131 mutex_unlock(&ctl->request_queue_lock); in tb_cfg_request_enqueue()
134 req->ctl = ctl; in tb_cfg_request_enqueue()
135 list_add_tail(&req->list, &ctl->request_queue); in tb_cfg_request_enqueue()
137 mutex_unlock(&ctl->request_queue_lock); in tb_cfg_request_enqueue()
143 struct tb_ctl *ctl = req->ctl; in tb_cfg_request_dequeue() local
145 mutex_lock(&ctl->request_queue_lock); in tb_cfg_request_dequeue()
150 mutex_unlock(&ctl->request_queue_lock); in tb_cfg_request_dequeue()
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()
173 mutex_unlock(&pkg->ctl->request_queue_lock); in tb_cfg_request_find()
234 struct tb_ctl *ctl = response->ctl; in decode_error() local
244 tb_ctl_warn(ctl, "pkg->zero1 is %#x\n", pkg->zero1); in decode_error()
246 tb_ctl_warn(ctl, "pkg->zero2 is %#x\n", pkg->zero2); in decode_error()
248 tb_ctl_warn(ctl, "pkg->zero3 is %#x\n", pkg->zero3); in decode_error()
272 static void tb_cfg_print_error(struct tb_ctl *ctl, in tb_cfg_print_error() argument
286 tb_ctl_dbg(ctl, "%llx:%x: invalid config space or offset\n", in tb_cfg_print_error()
295 tb_ctl_WARN(ctl, "CFG_ERROR(%llx:%x): Invalid port\n", in tb_cfg_print_error()
299 tb_ctl_WARN(ctl, "CFG_ERROR(%llx:%x): Route contains a loop\n", in tb_cfg_print_error()
303 tb_ctl_warn(ctl, "%llx:%x: downstream port is locked\n", in tb_cfg_print_error()
308 tb_ctl_WARN(ctl, "CFG_ERROR(%llx:%x): Unknown error\n", in tb_cfg_print_error()
322 dma_pool_free(pkg->ctl->frame_pool, in tb_ctl_pkg_free()
328 static struct ctl_pkg *tb_ctl_pkg_alloc(struct tb_ctl *ctl) in tb_ctl_pkg_alloc() argument
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()
360 static int tb_ctl_tx(struct tb_ctl *ctl, const void *data, size_t len, in tb_ctl_tx() argument
366 tb_ctl_WARN(ctl, "TX: invalid size: %zu\n", len); in tb_ctl_tx()
370 tb_ctl_WARN(ctl, "TX: packet too large: %zu/%d\n", in tb_ctl_tx()
374 pkg = tb_ctl_pkg_alloc(ctl); in tb_ctl_tx()
384 res = tb_ring_tx(ctl->tx, &pkg->frame); in tb_ctl_tx()
393 static bool tb_ctl_handle_event(struct tb_ctl *ctl, enum tb_cfg_pkg_type type, in tb_ctl_handle_event() argument
396 return ctl->callback(ctl->callback_data, type, pkg->buffer, size); in tb_ctl_handle_event()
401 tb_ring_rx(pkg->ctl->rx, &pkg->frame); /* in tb_ctl_rx_submit()
441 tb_ctl_err(pkg->ctl, "RX: invalid size %#x, dropping packet\n", in tb_ctl_rx_callback()
457 tb_ctl_err(pkg->ctl, in tb_ctl_rx_callback()
462 tb_ctl_handle_event(pkg->ctl, frame->eof, 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()
524 int tb_cfg_request(struct tb_ctl *ctl, struct tb_cfg_request *req, in tb_cfg_request() argument
536 ret = tb_cfg_request_enqueue(ctl, req); in tb_cfg_request()
540 ret = tb_ctl_tx(ctl, req->request, req->request_size, in tb_cfg_request()
590 struct tb_cfg_result tb_cfg_request_sync(struct tb_ctl *ctl, in tb_cfg_request_sync() argument
599 ret = tb_cfg_request(ctl, req, tb_cfg_request_complete, &done); in tb_cfg_request_sync()
630 struct tb_ctl *ctl = kzalloc(sizeof(*ctl), GFP_KERNEL); in tb_ctl_alloc() local
631 if (!ctl) in tb_ctl_alloc()
633 ctl->nhi = nhi; in tb_ctl_alloc()
634 ctl->timeout_msec = timeout_msec; in tb_ctl_alloc()
635 ctl->callback = cb; in tb_ctl_alloc()
636 ctl->callback_data = cb_data; in tb_ctl_alloc()
638 mutex_init(&ctl->request_queue_lock); in tb_ctl_alloc()
639 INIT_LIST_HEAD(&ctl->request_queue); in tb_ctl_alloc()
640 ctl->frame_pool = dma_pool_create("thunderbolt_ctl", &nhi->pdev->dev, in tb_ctl_alloc()
642 if (!ctl->frame_pool) in tb_ctl_alloc()
645 ctl->tx = tb_ring_alloc_tx(nhi, 0, 10, RING_FLAG_NO_SUSPEND); in tb_ctl_alloc()
646 if (!ctl->tx) in tb_ctl_alloc()
649 ctl->rx = tb_ring_alloc_rx(nhi, 0, 10, RING_FLAG_NO_SUSPEND, 0, 0xffff, in tb_ctl_alloc()
651 if (!ctl->rx) in tb_ctl_alloc()
655 ctl->rx_packets[i] = tb_ctl_pkg_alloc(ctl); in tb_ctl_alloc()
656 if (!ctl->rx_packets[i]) in tb_ctl_alloc()
658 ctl->rx_packets[i]->frame.callback = tb_ctl_rx_callback; in tb_ctl_alloc()
661 tb_ctl_dbg(ctl, "control channel created\n"); in tb_ctl_alloc()
662 return ctl; in tb_ctl_alloc()
664 tb_ctl_free(ctl); in tb_ctl_alloc()
676 void tb_ctl_free(struct tb_ctl *ctl) in tb_ctl_free() argument
680 if (!ctl) in tb_ctl_free()
683 if (ctl->rx) in tb_ctl_free()
684 tb_ring_free(ctl->rx); in tb_ctl_free()
685 if (ctl->tx) in tb_ctl_free()
686 tb_ring_free(ctl->tx); in tb_ctl_free()
690 tb_ctl_pkg_free(ctl->rx_packets[i]); in tb_ctl_free()
693 dma_pool_destroy(ctl->frame_pool); in tb_ctl_free()
694 kfree(ctl); in tb_ctl_free()
701 void tb_ctl_start(struct tb_ctl *ctl) in tb_ctl_start() argument
704 tb_ctl_dbg(ctl, "control channel starting...\n"); in tb_ctl_start()
705 tb_ring_start(ctl->tx); /* is used to ack hotplug packets, start first */ in tb_ctl_start()
706 tb_ring_start(ctl->rx); in tb_ctl_start()
708 tb_ctl_rx_submit(ctl->rx_packets[i]); in tb_ctl_start()
710 ctl->running = true; in tb_ctl_start()
722 void tb_ctl_stop(struct tb_ctl *ctl) in tb_ctl_stop() argument
724 mutex_lock(&ctl->request_queue_lock); in tb_ctl_stop()
725 ctl->running = false; in tb_ctl_stop()
726 mutex_unlock(&ctl->request_queue_lock); in tb_ctl_stop()
728 tb_ring_stop(ctl->rx); in tb_ctl_stop()
729 tb_ring_stop(ctl->tx); in tb_ctl_stop()
731 if (!list_empty(&ctl->request_queue)) in tb_ctl_stop()
732 tb_ctl_WARN(ctl, "dangling request in request_queue\n"); in tb_ctl_stop()
733 INIT_LIST_HEAD(&ctl->request_queue); in tb_ctl_stop()
734 tb_ctl_dbg(ctl, "control channel stopped\n"); in tb_ctl_stop()
749 int tb_cfg_ack_plug(struct tb_ctl *ctl, u64 route, u32 port, bool unplug) in tb_cfg_ack_plug() argument
758 tb_ctl_dbg(ctl, "acking hot %splug event on %llx:%x\n", in tb_cfg_ack_plug()
760 return tb_ctl_tx(ctl, &pkg, sizeof(pkg), TB_CFG_PKG_ERROR); in tb_cfg_ack_plug()
815 struct tb_cfg_result tb_cfg_reset(struct tb_ctl *ctl, u64 route) in tb_cfg_reset() argument
837 res = tb_cfg_request_sync(ctl, req, ctl->timeout_msec); in tb_cfg_reset()
857 struct tb_cfg_result tb_cfg_read_raw(struct tb_ctl *ctl, void *buffer, in tb_cfg_read_raw() argument
894 res = tb_cfg_request_sync(ctl, req, timeout_msec); in tb_cfg_read_raw()
928 struct tb_cfg_result tb_cfg_write_raw(struct tb_ctl *ctl, const void *buffer, in tb_cfg_write_raw() argument
967 res = tb_cfg_request_sync(ctl, req, timeout_msec); in tb_cfg_write_raw()
986 static int tb_cfg_get_error(struct tb_ctl *ctl, enum tb_cfg_space space, in tb_cfg_get_error() argument
999 tb_cfg_print_error(ctl, res); in tb_cfg_get_error()
1009 int tb_cfg_read(struct tb_ctl *ctl, void *buffer, u64 route, u32 port, in tb_cfg_read() argument
1012 struct tb_cfg_result res = tb_cfg_read_raw(ctl, buffer, route, port, in tb_cfg_read()
1013 space, offset, length, ctl->timeout_msec); in tb_cfg_read()
1021 return tb_cfg_get_error(ctl, space, &res); in tb_cfg_read()
1024 tb_ctl_warn(ctl, "%llx: timeout reading config space %u from %#x\n", in tb_cfg_read()
1035 int tb_cfg_write(struct tb_ctl *ctl, const void *buffer, u64 route, u32 port, in tb_cfg_write() argument
1038 struct tb_cfg_result res = tb_cfg_write_raw(ctl, buffer, route, port, in tb_cfg_write()
1039 space, offset, length, ctl->timeout_msec); in tb_cfg_write()
1047 return tb_cfg_get_error(ctl, space, &res); in tb_cfg_write()
1050 tb_ctl_warn(ctl, "%llx: timeout writing config space %u to %#x\n", in tb_cfg_write()
1072 int tb_cfg_get_upstream_port(struct tb_ctl *ctl, u64 route) in tb_cfg_get_upstream_port() argument
1075 struct tb_cfg_result res = tb_cfg_read_raw(ctl, &dummy, route, 0, in tb_cfg_get_upstream_port()
1077 ctl->timeout_msec); in tb_cfg_get_upstream_port()