Lines Matching refs:port
167 struct port { struct
234 static struct port *find_port_by_vtermno(u32 vtermno) in find_port_by_vtermno() argument
236 struct port *port; in find_port_by_vtermno() local
243 port = container_of(cons, struct port, cons); in find_port_by_vtermno()
247 port = NULL; in find_port_by_vtermno()
250 return port; in find_port_by_vtermno()
253 static struct port *find_port_by_devt_in_portdev(struct ports_device *portdev, in find_port_by_devt_in_portdev()
256 struct port *port; in find_port_by_devt_in_portdev() local
260 list_for_each_entry(port, &portdev->ports, list) { in find_port_by_devt_in_portdev()
261 if (port->cdev->dev == dev) { in find_port_by_devt_in_portdev()
262 kref_get(&port->kref); in find_port_by_devt_in_portdev()
266 port = NULL; in find_port_by_devt_in_portdev()
270 return port; in find_port_by_devt_in_portdev()
273 static struct port *find_port_by_devt(dev_t dev) in find_port_by_devt()
276 struct port *port; in find_port_by_devt() local
281 port = find_port_by_devt_in_portdev(portdev, dev); in find_port_by_devt()
282 if (port) in find_port_by_devt()
285 port = NULL; in find_port_by_devt()
288 return port; in find_port_by_devt()
291 static struct port *find_port_by_id(struct ports_device *portdev, u32 id) in find_port_by_id()
293 struct port *port; in find_port_by_id() local
297 list_for_each_entry(port, &portdev->ports, list) in find_port_by_id()
298 if (port->id == id) in find_port_by_id()
300 port = NULL; in find_port_by_id()
304 return port; in find_port_by_id()
307 static struct port *find_port_by_vq(struct ports_device *portdev, in find_port_by_vq()
310 struct port *port; in find_port_by_vq() local
314 list_for_each_entry(port, &portdev->ports, list) in find_port_by_vq()
315 if (port->in_vq == vq || port->out_vq == vq) in find_port_by_vq()
317 port = NULL; in find_port_by_vq()
320 return port; in find_port_by_vq()
323 static bool is_console_port(struct port *port) in is_console_port() argument
325 if (port->cons.hvc) in is_console_port()
460 static struct port_buffer *get_inbuf(struct port *port) in get_inbuf() argument
465 if (port->inbuf) in get_inbuf()
466 return port->inbuf; in get_inbuf()
468 buf = virtqueue_get_buf(port->in_vq, &len); in get_inbuf()
472 port->stats.bytes_received += len; in get_inbuf()
498 static void discard_port_data(struct port *port) in discard_port_data() argument
503 if (!port->portdev) { in discard_port_data()
507 buf = get_inbuf(port); in discard_port_data()
511 port->stats.bytes_discarded += buf->len - buf->offset; in discard_port_data()
512 if (add_inbuf(port->in_vq, buf) < 0) { in discard_port_data()
516 port->inbuf = NULL; in discard_port_data()
517 buf = get_inbuf(port); in discard_port_data()
520 dev_warn(port->dev, "Errors adding %d buffers back to vq\n", in discard_port_data()
524 static bool port_has_data(struct port *port) in port_has_data() argument
530 spin_lock_irqsave(&port->inbuf_lock, flags); in port_has_data()
531 port->inbuf = get_inbuf(port); in port_has_data()
532 if (port->inbuf) in port_has_data()
535 spin_unlock_irqrestore(&port->inbuf_lock, flags); in port_has_data()
570 static ssize_t send_control_msg(struct port *port, unsigned int event, in send_control_msg() argument
574 if (port->portdev) in send_control_msg()
575 return __send_control_msg(port->portdev, port->id, event, value); in send_control_msg()
581 static void reclaim_consumed_buffers(struct port *port) in reclaim_consumed_buffers() argument
586 if (!port->portdev) { in reclaim_consumed_buffers()
590 while ((buf = virtqueue_get_buf(port->out_vq, &len))) { in reclaim_consumed_buffers()
592 port->outvq_full = false; in reclaim_consumed_buffers()
596 static ssize_t __send_to_port(struct port *port, struct scatterlist *sg, in __send_to_port() argument
605 out_vq = port->out_vq; in __send_to_port()
607 spin_lock_irqsave(&port->outvq_lock, flags); in __send_to_port()
609 reclaim_consumed_buffers(port); in __send_to_port()
622 port->outvq_full = true; in __send_to_port()
640 spin_unlock_irqrestore(&port->outvq_lock, flags); in __send_to_port()
642 port->stats.bytes_sent += in_count; in __send_to_port()
654 static ssize_t fill_readbuf(struct port *port, u8 __user *out_buf, in fill_readbuf() argument
660 if (!out_count || !port_has_data(port)) in fill_readbuf()
663 buf = port->inbuf; in fill_readbuf()
684 spin_lock_irqsave(&port->inbuf_lock, flags); in fill_readbuf()
685 port->inbuf = NULL; in fill_readbuf()
687 if (add_inbuf(port->in_vq, buf) < 0) in fill_readbuf()
688 dev_warn(port->dev, "failed add_buf\n"); in fill_readbuf()
690 spin_unlock_irqrestore(&port->inbuf_lock, flags); in fill_readbuf()
697 static bool will_read_block(struct port *port) in will_read_block() argument
699 if (!port->guest_connected) { in will_read_block()
703 return !port_has_data(port) && port->host_connected; in will_read_block()
706 static bool will_write_block(struct port *port) in will_write_block() argument
710 if (!port->guest_connected) { in will_write_block()
714 if (!port->host_connected) in will_write_block()
717 spin_lock_irq(&port->outvq_lock); in will_write_block()
722 reclaim_consumed_buffers(port); in will_write_block()
723 ret = port->outvq_full; in will_write_block()
724 spin_unlock_irq(&port->outvq_lock); in will_write_block()
732 struct port *port; in port_fops_read() local
735 port = filp->private_data; in port_fops_read()
738 if (!port->guest_connected) in port_fops_read()
741 if (!port_has_data(port)) { in port_fops_read()
747 if (!port->host_connected) in port_fops_read()
752 ret = wait_event_freezable(port->waitqueue, in port_fops_read()
753 !will_read_block(port)); in port_fops_read()
758 if (!port->guest_connected) in port_fops_read()
770 if (!port_has_data(port) && !port->host_connected) in port_fops_read()
773 return fill_readbuf(port, ubuf, count, true); in port_fops_read()
776 static int wait_port_writable(struct port *port, bool nonblock) in wait_port_writable() argument
780 if (will_write_block(port)) { in wait_port_writable()
784 ret = wait_event_freezable(port->waitqueue, in wait_port_writable()
785 !will_write_block(port)); in wait_port_writable()
790 if (!port->guest_connected) in wait_port_writable()
799 struct port *port; in port_fops_write() local
809 port = filp->private_data; in port_fops_write()
813 ret = wait_port_writable(port, nonblock); in port_fops_write()
819 buf = alloc_buf(port->portdev->vdev, count, 0); in port_fops_write()
838 ret = __send_to_port(port, sg, 1, count, buf, nonblock); in port_fops_write()
904 struct port *port = filp->private_data; in port_fops_splice_write() local
922 if (is_rproc_serial(port->out_vq->vdev)) in port_fops_splice_write()
930 ret = wait_port_writable(port, filp->f_flags & O_NONBLOCK); in port_fops_splice_write()
935 buf = alloc_buf(port->portdev->vdev, 0, occupancy); in port_fops_splice_write()
950 ret = __send_to_port(port, buf->sg, sgl.n, sgl.len, buf, true); in port_fops_splice_write()
963 struct port *port; in port_fops_poll() local
966 port = filp->private_data; in port_fops_poll()
967 poll_wait(filp, &port->waitqueue, wait); in port_fops_poll()
969 if (!port->guest_connected) { in port_fops_poll()
974 if (!will_read_block(port)) in port_fops_poll()
976 if (!will_write_block(port)) in port_fops_poll()
978 if (!port->host_connected) in port_fops_poll()
988 struct port *port; in port_fops_release() local
990 port = filp->private_data; in port_fops_release()
993 send_control_msg(port, VIRTIO_CONSOLE_PORT_OPEN, 0); in port_fops_release()
995 spin_lock_irq(&port->inbuf_lock); in port_fops_release()
996 port->guest_connected = false; in port_fops_release()
998 discard_port_data(port); in port_fops_release()
1000 spin_unlock_irq(&port->inbuf_lock); in port_fops_release()
1002 spin_lock_irq(&port->outvq_lock); in port_fops_release()
1003 reclaim_consumed_buffers(port); in port_fops_release()
1004 spin_unlock_irq(&port->outvq_lock); in port_fops_release()
1015 kref_put(&port->kref, remove_port); in port_fops_release()
1023 struct port *port; in port_fops_open() local
1027 port = find_port_by_devt(cdev->dev); in port_fops_open()
1028 if (!port) { in port_fops_open()
1032 filp->private_data = port; in port_fops_open()
1038 if (is_console_port(port)) { in port_fops_open()
1044 spin_lock_irq(&port->inbuf_lock); in port_fops_open()
1045 if (port->guest_connected) { in port_fops_open()
1046 spin_unlock_irq(&port->inbuf_lock); in port_fops_open()
1051 port->guest_connected = true; in port_fops_open()
1052 spin_unlock_irq(&port->inbuf_lock); in port_fops_open()
1054 spin_lock_irq(&port->outvq_lock); in port_fops_open()
1060 reclaim_consumed_buffers(port); in port_fops_open()
1061 spin_unlock_irq(&port->outvq_lock); in port_fops_open()
1070 kref_put(&port->kref, remove_port); in port_fops_open()
1076 struct port *port; in port_fops_fasync() local
1078 port = filp->private_data; in port_fops_fasync()
1079 return fasync_helper(fd, filp, mode, &port->async_queue); in port_fops_fasync()
1109 struct port *port; in put_chars() local
1114 port = find_port_by_vtermno(vtermno); in put_chars()
1115 if (!port) in put_chars()
1123 ret = __send_to_port(port, sg, 1, count, data, false); in put_chars()
1137 struct port *port; in get_chars() local
1139 port = find_port_by_vtermno(vtermno); in get_chars()
1140 if (!port) in get_chars()
1144 BUG_ON(!port->in_vq); in get_chars()
1146 return fill_readbuf(port, (__force u8 __user *)buf, count, false); in get_chars()
1149 static void resize_console(struct port *port) in resize_console() argument
1154 if (!port || !is_console_port(port)) in resize_console()
1157 vdev = port->portdev->vdev; in resize_console()
1162 hvc_resize(port->cons.hvc, port->cons.ws); in resize_console()
1168 struct port *port; in notifier_add_vio() local
1170 port = find_port_by_vtermno(hp->vtermno); in notifier_add_vio()
1171 if (!port) in notifier_add_vio()
1175 resize_console(port); in notifier_add_vio()
1194 static int init_port_console(struct port *port) in init_port_console() argument
1219 port->cons.vtermno = ret; in init_port_console()
1220 port->cons.hvc = hvc_alloc(port->cons.vtermno, 0, &hv_ops, PAGE_SIZE); in init_port_console()
1221 if (IS_ERR(port->cons.hvc)) { in init_port_console()
1222 ret = PTR_ERR(port->cons.hvc); in init_port_console()
1223 dev_err(port->dev, in init_port_console()
1225 port->cons.hvc = NULL; in init_port_console()
1226 ida_free(&vtermno_ida, port->cons.vtermno); in init_port_console()
1230 list_add_tail(&port->cons.list, &pdrvdata.consoles); in init_port_console()
1232 port->guest_connected = true; in init_port_console()
1235 send_control_msg(port, VIRTIO_CONSOLE_PORT_OPEN, 1); in init_port_console()
1243 struct port *port; in show_port_name() local
1245 port = dev_get_drvdata(dev); in show_port_name()
1247 return sprintf(buffer, "%s\n", port->name); in show_port_name()
1264 struct port *port = s->private; in port_debugfs_show() local
1266 seq_printf(s, "name: %s\n", port->name ? port->name : ""); in port_debugfs_show()
1267 seq_printf(s, "guest_connected: %d\n", port->guest_connected); in port_debugfs_show()
1268 seq_printf(s, "host_connected: %d\n", port->host_connected); in port_debugfs_show()
1269 seq_printf(s, "outvq_full: %d\n", port->outvq_full); in port_debugfs_show()
1270 seq_printf(s, "bytes_sent: %lu\n", port->stats.bytes_sent); in port_debugfs_show()
1271 seq_printf(s, "bytes_received: %lu\n", port->stats.bytes_received); in port_debugfs_show()
1272 seq_printf(s, "bytes_discarded: %lu\n", port->stats.bytes_discarded); in port_debugfs_show()
1273 seq_printf(s, "is_console: %s\n", str_yes_no(is_console_port(port))); in port_debugfs_show()
1274 seq_printf(s, "console_vtermno: %u\n", port->cons.vtermno); in port_debugfs_show()
1281 static void set_console_size(struct port *port, u16 rows, u16 cols) in set_console_size() argument
1283 if (!port || !is_console_port(port)) in set_console_size()
1286 port->cons.ws.ws_row = rows; in set_console_size()
1287 port->cons.ws.ws_col = cols; in set_console_size()
1316 static void send_sigio_to_port(struct port *port) in send_sigio_to_port() argument
1318 if (port->async_queue && port->guest_connected) in send_sigio_to_port()
1319 kill_fasync(&port->async_queue, SIGIO, POLL_OUT); in send_sigio_to_port()
1324 struct port *port; in add_port() local
1328 port = kmalloc(sizeof(*port), GFP_KERNEL); in add_port()
1329 if (!port) { in add_port()
1333 kref_init(&port->kref); in add_port()
1335 port->portdev = portdev; in add_port()
1336 port->id = id; in add_port()
1338 port->name = NULL; in add_port()
1339 port->inbuf = NULL; in add_port()
1340 port->cons.hvc = NULL; in add_port()
1341 port->async_queue = NULL; in add_port()
1343 port->cons.ws.ws_row = port->cons.ws.ws_col = 0; in add_port()
1344 port->cons.vtermno = 0; in add_port()
1346 port->host_connected = port->guest_connected = false; in add_port()
1347 port->stats = (struct port_stats) { 0 }; in add_port()
1349 port->outvq_full = false; in add_port()
1351 port->in_vq = portdev->in_vqs[port->id]; in add_port()
1352 port->out_vq = portdev->out_vqs[port->id]; in add_port()
1354 port->cdev = cdev_alloc(); in add_port()
1355 if (!port->cdev) { in add_port()
1356 dev_err(&port->portdev->vdev->dev, "Error allocating cdev\n"); in add_port()
1360 port->cdev->ops = &port_fops; in add_port()
1363 err = cdev_add(port->cdev, devt, 1); in add_port()
1365 dev_err(&port->portdev->vdev->dev, in add_port()
1369 port->dev = device_create(&port_class, &port->portdev->vdev->dev, in add_port()
1370 devt, port, "vport%up%u", in add_port()
1371 port->portdev->vdev->index, id); in add_port()
1372 if (IS_ERR(port->dev)) { in add_port()
1373 err = PTR_ERR(port->dev); in add_port()
1374 dev_err(&port->portdev->vdev->dev, in add_port()
1380 spin_lock_init(&port->inbuf_lock); in add_port()
1381 spin_lock_init(&port->outvq_lock); in add_port()
1382 init_waitqueue_head(&port->waitqueue); in add_port()
1388 err = fill_queue(port->in_vq, &port->inbuf_lock); in add_port()
1390 dev_err(port->dev, "Error allocating inbufs\n"); in add_port()
1394 if (is_rproc_serial(port->portdev->vdev)) in add_port()
1400 port->host_connected = true; in add_port()
1401 else if (!use_multiport(port->portdev)) { in add_port()
1406 err = init_port_console(port); in add_port()
1412 list_add_tail(&port->list, &port->portdev->ports); in add_port()
1420 send_control_msg(port, VIRTIO_CONSOLE_PORT_READY, 1); in add_port()
1426 port->debugfs_file = debugfs_create_file(dev_name(port->dev), 0444, in add_port()
1428 port, &port_debugfs_fops); in add_port()
1433 device_destroy(&port_class, port->dev->devt); in add_port()
1435 cdev_del(port->cdev); in add_port()
1437 kfree(port); in add_port()
1447 struct port *port; in remove_port() local
1449 port = container_of(kref, struct port, kref); in remove_port()
1451 kfree(port); in remove_port()
1454 static void remove_port_data(struct port *port) in remove_port_data() argument
1456 spin_lock_irq(&port->inbuf_lock); in remove_port_data()
1458 discard_port_data(port); in remove_port_data()
1459 spin_unlock_irq(&port->inbuf_lock); in remove_port_data()
1461 spin_lock_irq(&port->outvq_lock); in remove_port_data()
1462 reclaim_consumed_buffers(port); in remove_port_data()
1463 spin_unlock_irq(&port->outvq_lock); in remove_port_data()
1471 static void unplug_port(struct port *port) in unplug_port() argument
1473 spin_lock_irq(&port->portdev->ports_lock); in unplug_port()
1474 list_del(&port->list); in unplug_port()
1475 spin_unlock_irq(&port->portdev->ports_lock); in unplug_port()
1477 spin_lock_irq(&port->inbuf_lock); in unplug_port()
1478 if (port->guest_connected) { in unplug_port()
1480 send_sigio_to_port(port); in unplug_port()
1483 port->guest_connected = false; in unplug_port()
1484 port->host_connected = false; in unplug_port()
1486 wake_up_interruptible(&port->waitqueue); in unplug_port()
1488 spin_unlock_irq(&port->inbuf_lock); in unplug_port()
1490 if (is_console_port(port)) { in unplug_port()
1492 list_del(&port->cons.list); in unplug_port()
1494 hvc_remove(port->cons.hvc); in unplug_port()
1495 ida_free(&vtermno_ida, port->cons.vtermno); in unplug_port()
1498 remove_port_data(port); in unplug_port()
1505 port->portdev = NULL; in unplug_port()
1507 sysfs_remove_group(&port->dev->kobj, &port_attribute_group); in unplug_port()
1508 device_destroy(&port_class, port->dev->devt); in unplug_port()
1509 cdev_del(port->cdev); in unplug_port()
1511 debugfs_remove(port->debugfs_file); in unplug_port()
1512 kfree(port->name); in unplug_port()
1519 kref_put(&port->kref, remove_port); in unplug_port()
1528 struct port *port; in handle_control_message() local
1534 port = find_port_by_id(portdev, virtio32_to_cpu(vdev, cpkt->id)); in handle_control_message()
1535 if (!port && in handle_control_message()
1545 if (port) { in handle_control_message()
1547 "Port %u already added\n", port->id); in handle_control_message()
1548 send_control_msg(port, VIRTIO_CONSOLE_PORT_READY, 1); in handle_control_message()
1562 unplug_port(port); in handle_control_message()
1567 if (is_console_port(port)) in handle_control_message()
1570 init_port_console(port); in handle_control_message()
1583 if (!is_console_port(port)) in handle_control_message()
1588 set_console_size(port, virtio16_to_cpu(vdev, size.rows), in handle_control_message()
1591 port->cons.hvc->irq_requested = 1; in handle_control_message()
1592 resize_console(port); in handle_control_message()
1596 port->host_connected = virtio16_to_cpu(vdev, cpkt->value); in handle_control_message()
1597 wake_up_interruptible(&port->waitqueue); in handle_control_message()
1603 spin_lock_irq(&port->outvq_lock); in handle_control_message()
1604 reclaim_consumed_buffers(port); in handle_control_message()
1605 spin_unlock_irq(&port->outvq_lock); in handle_control_message()
1611 spin_lock_irq(&port->inbuf_lock); in handle_control_message()
1612 send_sigio_to_port(port); in handle_control_message()
1613 spin_unlock_irq(&port->inbuf_lock); in handle_control_message()
1620 if (port->name) in handle_control_message()
1629 port->name = kmalloc(name_size, GFP_KERNEL); in handle_control_message()
1630 if (!port->name) { in handle_control_message()
1631 dev_err(port->dev, in handle_control_message()
1635 strscpy(port->name, buf->buf + buf->offset + sizeof(*cpkt), in handle_control_message()
1642 err = sysfs_create_group(&port->dev->kobj, in handle_control_message()
1645 dev_err(port->dev, in handle_control_message()
1654 kobject_uevent(&port->dev->kobj, KOBJ_CHANGE); in handle_control_message()
1700 struct port *port; in out_intr() local
1702 port = find_port_by_vq(vq->vdev->priv, vq); in out_intr()
1703 if (!port) { in out_intr()
1708 wake_up_interruptible(&port->waitqueue); in out_intr()
1713 struct port *port; in in_intr() local
1716 port = find_port_by_vq(vq->vdev->priv, vq); in in_intr()
1717 if (!port) { in in_intr()
1722 spin_lock_irqsave(&port->inbuf_lock, flags); in in_intr()
1723 port->inbuf = get_inbuf(port); in in_intr()
1742 if (!port->guest_connected && !is_rproc_serial(port->portdev->vdev)) in in_intr()
1743 discard_port_data(port); in in_intr()
1746 send_sigio_to_port(port); in in_intr()
1748 spin_unlock_irqrestore(&port->inbuf_lock, flags); in in_intr()
1750 wake_up_interruptible(&port->waitqueue); in in_intr()
1752 if (is_console_port(port) && hvc_poll(port->cons.hvc)) in in_intr()
1781 struct port *port; in config_work_handler() local
1788 port = find_port_by_id(portdev, 0); in config_work_handler()
1789 set_console_size(port, rows, cols); in config_work_handler()
1798 resize_console(port); in config_work_handler()
1905 struct port *port, *port2; in virtcons_remove() local
1928 list_for_each_entry_safe(port, port2, &portdev->ports, list) in virtcons_remove()
1929 unplug_port(port); in virtcons_remove()
2093 struct port *port; in virtcons_freeze() local
2110 list_for_each_entry(port, &portdev->ports, list) { in virtcons_freeze()
2111 virtqueue_disable_cb(port->in_vq); in virtcons_freeze()
2112 virtqueue_disable_cb(port->out_vq); in virtcons_freeze()
2117 port->host_connected = false; in virtcons_freeze()
2118 remove_port_data(port); in virtcons_freeze()
2128 struct port *port; in virtcons_restore() local
2142 list_for_each_entry(port, &portdev->ports, list) { in virtcons_restore()
2143 port->in_vq = portdev->in_vqs[port->id]; in virtcons_restore()
2144 port->out_vq = portdev->out_vqs[port->id]; in virtcons_restore()
2146 fill_queue(port->in_vq, &port->inbuf_lock); in virtcons_restore()
2149 send_control_msg(port, VIRTIO_CONSOLE_PORT_READY, 1); in virtcons_restore()
2155 if (port->guest_connected) in virtcons_restore()
2156 send_control_msg(port, VIRTIO_CONSOLE_PORT_OPEN, 1); in virtcons_restore()