Lines Matching refs:port
180 struct port { struct
250 static struct port *find_port_by_vtermno(u32 vtermno) in find_port_by_vtermno() argument
252 struct port *port; in find_port_by_vtermno() local
259 port = container_of(cons, struct port, cons); in find_port_by_vtermno()
263 port = NULL; in find_port_by_vtermno()
266 return port; in find_port_by_vtermno()
269 static struct port *find_port_by_devt_in_portdev(struct ports_device *portdev, in find_port_by_devt_in_portdev()
272 struct port *port; in find_port_by_devt_in_portdev() local
276 list_for_each_entry(port, &portdev->ports, list) { in find_port_by_devt_in_portdev()
277 if (port->cdev->dev == dev) { in find_port_by_devt_in_portdev()
278 kref_get(&port->kref); in find_port_by_devt_in_portdev()
282 port = NULL; in find_port_by_devt_in_portdev()
286 return port; in find_port_by_devt_in_portdev()
289 static struct port *find_port_by_devt(dev_t dev) in find_port_by_devt()
292 struct port *port; in find_port_by_devt() local
297 port = find_port_by_devt_in_portdev(portdev, dev); in find_port_by_devt()
298 if (port) in find_port_by_devt()
301 port = NULL; in find_port_by_devt()
304 return port; in find_port_by_devt()
307 static struct port *find_port_by_id(struct ports_device *portdev, u32 id) in find_port_by_id()
309 struct port *port; in find_port_by_id() local
313 list_for_each_entry(port, &portdev->ports, list) in find_port_by_id()
314 if (port->id == id) in find_port_by_id()
316 port = NULL; in find_port_by_id()
320 return port; in find_port_by_id()
323 static struct port *find_port_by_vq(struct ports_device *portdev, in find_port_by_vq()
326 struct port *port; in find_port_by_vq() local
330 list_for_each_entry(port, &portdev->ports, list) in find_port_by_vq()
331 if (port->in_vq == vq || port->out_vq == vq) in find_port_by_vq()
333 port = NULL; in find_port_by_vq()
336 return port; in find_port_by_vq()
339 static bool is_console_port(struct port *port) in is_console_port() argument
341 if (port->cons.hvc) in is_console_port()
480 static struct port_buffer *get_inbuf(struct port *port) in get_inbuf() argument
485 if (port->inbuf) in get_inbuf()
486 return port->inbuf; in get_inbuf()
488 buf = virtqueue_get_buf(port->in_vq, &len); in get_inbuf()
492 port->stats.bytes_received += len; in get_inbuf()
518 static void discard_port_data(struct port *port) in discard_port_data() argument
523 if (!port->portdev) { in discard_port_data()
527 buf = get_inbuf(port); in discard_port_data()
531 port->stats.bytes_discarded += buf->len - buf->offset; in discard_port_data()
532 if (add_inbuf(port->in_vq, buf) < 0) { in discard_port_data()
536 port->inbuf = NULL; in discard_port_data()
537 buf = get_inbuf(port); in discard_port_data()
540 dev_warn(port->dev, "Errors adding %d buffers back to vq\n", in discard_port_data()
544 static bool port_has_data(struct port *port) in port_has_data() argument
550 spin_lock_irqsave(&port->inbuf_lock, flags); in port_has_data()
551 port->inbuf = get_inbuf(port); in port_has_data()
552 if (port->inbuf) in port_has_data()
555 spin_unlock_irqrestore(&port->inbuf_lock, flags); in port_has_data()
589 static ssize_t send_control_msg(struct port *port, unsigned int event, in send_control_msg() argument
593 if (port->portdev) in send_control_msg()
594 return __send_control_msg(port->portdev, port->id, event, value); in send_control_msg()
600 static void reclaim_consumed_buffers(struct port *port) in reclaim_consumed_buffers() argument
605 if (!port->portdev) { in reclaim_consumed_buffers()
609 while ((buf = virtqueue_get_buf(port->out_vq, &len))) { in reclaim_consumed_buffers()
611 port->outvq_full = false; in reclaim_consumed_buffers()
615 static ssize_t __send_to_port(struct port *port, struct scatterlist *sg, in __send_to_port() argument
624 out_vq = port->out_vq; in __send_to_port()
626 spin_lock_irqsave(&port->outvq_lock, flags); in __send_to_port()
628 reclaim_consumed_buffers(port); in __send_to_port()
641 port->outvq_full = true; in __send_to_port()
659 spin_unlock_irqrestore(&port->outvq_lock, flags); in __send_to_port()
661 port->stats.bytes_sent += in_count; in __send_to_port()
673 static ssize_t fill_readbuf(struct port *port, char __user *out_buf, in fill_readbuf() argument
679 if (!out_count || !port_has_data(port)) in fill_readbuf()
682 buf = port->inbuf; in fill_readbuf()
703 spin_lock_irqsave(&port->inbuf_lock, flags); in fill_readbuf()
704 port->inbuf = NULL; in fill_readbuf()
706 if (add_inbuf(port->in_vq, buf) < 0) in fill_readbuf()
707 dev_warn(port->dev, "failed add_buf\n"); in fill_readbuf()
709 spin_unlock_irqrestore(&port->inbuf_lock, flags); in fill_readbuf()
716 static bool will_read_block(struct port *port) in will_read_block() argument
718 if (!port->guest_connected) { in will_read_block()
722 return !port_has_data(port) && port->host_connected; in will_read_block()
725 static bool will_write_block(struct port *port) in will_write_block() argument
729 if (!port->guest_connected) { in will_write_block()
733 if (!port->host_connected) in will_write_block()
736 spin_lock_irq(&port->outvq_lock); in will_write_block()
741 reclaim_consumed_buffers(port); in will_write_block()
742 ret = port->outvq_full; in will_write_block()
743 spin_unlock_irq(&port->outvq_lock); in will_write_block()
751 struct port *port; in port_fops_read() local
754 port = filp->private_data; in port_fops_read()
757 if (!port->guest_connected) in port_fops_read()
760 if (!port_has_data(port)) { in port_fops_read()
766 if (!port->host_connected) in port_fops_read()
771 ret = wait_event_freezable(port->waitqueue, in port_fops_read()
772 !will_read_block(port)); in port_fops_read()
777 if (!port->guest_connected) in port_fops_read()
789 if (!port_has_data(port) && !port->host_connected) in port_fops_read()
792 return fill_readbuf(port, ubuf, count, true); in port_fops_read()
795 static int wait_port_writable(struct port *port, bool nonblock) in wait_port_writable() argument
799 if (will_write_block(port)) { in wait_port_writable()
803 ret = wait_event_freezable(port->waitqueue, in wait_port_writable()
804 !will_write_block(port)); in wait_port_writable()
809 if (!port->guest_connected) in wait_port_writable()
818 struct port *port; in port_fops_write() local
828 port = filp->private_data; in port_fops_write()
832 ret = wait_port_writable(port, nonblock); in port_fops_write()
838 buf = alloc_buf(port->out_vq, count, 0); in port_fops_write()
857 ret = __send_to_port(port, sg, 1, count, buf, nonblock); in port_fops_write()
923 struct port *port = filp->private_data; in port_fops_splice_write() local
940 if (is_rproc_serial(port->out_vq->vdev)) in port_fops_splice_write()
953 ret = wait_port_writable(port, filp->f_flags & O_NONBLOCK); in port_fops_splice_write()
957 buf = alloc_buf(port->out_vq, 0, pipe->nrbufs); in port_fops_splice_write()
971 ret = __send_to_port(port, buf->sg, sgl.n, sgl.len, buf, true); in port_fops_splice_write()
984 struct port *port; in port_fops_poll() local
987 port = filp->private_data; in port_fops_poll()
988 poll_wait(filp, &port->waitqueue, wait); in port_fops_poll()
990 if (!port->guest_connected) { in port_fops_poll()
995 if (!will_read_block(port)) in port_fops_poll()
997 if (!will_write_block(port)) in port_fops_poll()
999 if (!port->host_connected) in port_fops_poll()
1009 struct port *port; in port_fops_release() local
1011 port = filp->private_data; in port_fops_release()
1014 send_control_msg(port, VIRTIO_CONSOLE_PORT_OPEN, 0); in port_fops_release()
1016 spin_lock_irq(&port->inbuf_lock); in port_fops_release()
1017 port->guest_connected = false; in port_fops_release()
1019 discard_port_data(port); in port_fops_release()
1021 spin_unlock_irq(&port->inbuf_lock); in port_fops_release()
1023 spin_lock_irq(&port->outvq_lock); in port_fops_release()
1024 reclaim_consumed_buffers(port); in port_fops_release()
1025 spin_unlock_irq(&port->outvq_lock); in port_fops_release()
1036 kref_put(&port->kref, remove_port); in port_fops_release()
1044 struct port *port; in port_fops_open() local
1048 port = find_port_by_devt(cdev->dev); in port_fops_open()
1049 if (!port) { in port_fops_open()
1053 filp->private_data = port; in port_fops_open()
1059 if (is_console_port(port)) { in port_fops_open()
1065 spin_lock_irq(&port->inbuf_lock); in port_fops_open()
1066 if (port->guest_connected) { in port_fops_open()
1067 spin_unlock_irq(&port->inbuf_lock); in port_fops_open()
1072 port->guest_connected = true; in port_fops_open()
1073 spin_unlock_irq(&port->inbuf_lock); in port_fops_open()
1075 spin_lock_irq(&port->outvq_lock); in port_fops_open()
1081 reclaim_consumed_buffers(port); in port_fops_open()
1082 spin_unlock_irq(&port->outvq_lock); in port_fops_open()
1091 kref_put(&port->kref, remove_port); in port_fops_open()
1097 struct port *port; in port_fops_fasync() local
1099 port = filp->private_data; in port_fops_fasync()
1100 return fasync_helper(fd, filp, mode, &port->async_queue); in port_fops_fasync()
1131 struct port *port; in put_chars() local
1137 port = find_port_by_vtermno(vtermno); in put_chars()
1138 if (!port) in put_chars()
1142 return __send_to_port(port, sg, 1, count, (void *)buf, false); in put_chars()
1154 struct port *port; in get_chars() local
1160 port = find_port_by_vtermno(vtermno); in get_chars()
1161 if (!port) in get_chars()
1165 BUG_ON(!port->in_vq); in get_chars()
1167 return fill_readbuf(port, (__force char __user *)buf, count, false); in get_chars()
1170 static void resize_console(struct port *port) in resize_console() argument
1175 if (!port || !is_console_port(port)) in resize_console()
1178 vdev = port->portdev->vdev; in resize_console()
1183 hvc_resize(port->cons.hvc, port->cons.ws); in resize_console()
1189 struct port *port; in notifier_add_vio() local
1191 port = find_port_by_vtermno(hp->vtermno); in notifier_add_vio()
1192 if (!port) in notifier_add_vio()
1196 resize_console(port); in notifier_add_vio()
1230 static int init_port_console(struct port *port) in init_port_console() argument
1251 port->cons.vtermno = pdrvdata.next_vtermno; in init_port_console()
1253 port->cons.hvc = hvc_alloc(port->cons.vtermno, 0, &hv_ops, PAGE_SIZE); in init_port_console()
1254 if (IS_ERR(port->cons.hvc)) { in init_port_console()
1255 ret = PTR_ERR(port->cons.hvc); in init_port_console()
1256 dev_err(port->dev, in init_port_console()
1258 port->cons.hvc = NULL; in init_port_console()
1263 list_add_tail(&port->cons.list, &pdrvdata.consoles); in init_port_console()
1265 port->guest_connected = true; in init_port_console()
1275 send_control_msg(port, VIRTIO_CONSOLE_PORT_OPEN, 1); in init_port_console()
1283 struct port *port; in show_port_name() local
1285 port = dev_get_drvdata(dev); in show_port_name()
1287 return sprintf(buffer, "%s\n", port->name); in show_port_name()
1305 struct port *port; in debugfs_read() local
1314 port = filp->private_data; in debugfs_read()
1317 "name: %s\n", port->name ? port->name : ""); in debugfs_read()
1319 "guest_connected: %d\n", port->guest_connected); in debugfs_read()
1321 "host_connected: %d\n", port->host_connected); in debugfs_read()
1323 "outvq_full: %d\n", port->outvq_full); in debugfs_read()
1325 "bytes_sent: %lu\n", port->stats.bytes_sent); in debugfs_read()
1328 port->stats.bytes_received); in debugfs_read()
1331 port->stats.bytes_discarded); in debugfs_read()
1334 is_console_port(port) ? "yes" : "no"); in debugfs_read()
1336 "console_vtermno: %u\n", port->cons.vtermno); in debugfs_read()
1349 static void set_console_size(struct port *port, u16 rows, u16 cols) in set_console_size() argument
1351 if (!port || !is_console_port(port)) in set_console_size()
1354 port->cons.ws.ws_row = rows; in set_console_size()
1355 port->cons.ws.ws_col = cols; in set_console_size()
1384 static void send_sigio_to_port(struct port *port) in send_sigio_to_port() argument
1386 if (port->async_queue && port->guest_connected) in send_sigio_to_port()
1387 kill_fasync(&port->async_queue, SIGIO, POLL_OUT); in send_sigio_to_port()
1393 struct port *port; in add_port() local
1399 port = kmalloc(sizeof(*port), GFP_KERNEL); in add_port()
1400 if (!port) { in add_port()
1404 kref_init(&port->kref); in add_port()
1406 port->portdev = portdev; in add_port()
1407 port->id = id; in add_port()
1409 port->name = NULL; in add_port()
1410 port->inbuf = NULL; in add_port()
1411 port->cons.hvc = NULL; in add_port()
1412 port->async_queue = NULL; in add_port()
1414 port->cons.ws.ws_row = port->cons.ws.ws_col = 0; in add_port()
1416 port->host_connected = port->guest_connected = false; in add_port()
1417 port->stats = (struct port_stats) { 0 }; in add_port()
1419 port->outvq_full = false; in add_port()
1421 port->in_vq = portdev->in_vqs[port->id]; in add_port()
1422 port->out_vq = portdev->out_vqs[port->id]; in add_port()
1424 port->cdev = cdev_alloc(); in add_port()
1425 if (!port->cdev) { in add_port()
1426 dev_err(&port->portdev->vdev->dev, "Error allocating cdev\n"); in add_port()
1430 port->cdev->ops = &port_fops; in add_port()
1433 err = cdev_add(port->cdev, devt, 1); in add_port()
1435 dev_err(&port->portdev->vdev->dev, in add_port()
1439 port->dev = device_create(pdrvdata.class, &port->portdev->vdev->dev, in add_port()
1440 devt, port, "vport%up%u", in add_port()
1441 port->portdev->vdev->index, id); in add_port()
1442 if (IS_ERR(port->dev)) { in add_port()
1443 err = PTR_ERR(port->dev); in add_port()
1444 dev_err(&port->portdev->vdev->dev, in add_port()
1450 spin_lock_init(&port->inbuf_lock); in add_port()
1451 spin_lock_init(&port->outvq_lock); in add_port()
1452 init_waitqueue_head(&port->waitqueue); in add_port()
1455 nr_added_bufs = fill_queue(port->in_vq, &port->inbuf_lock); in add_port()
1457 dev_err(port->dev, "Error allocating inbufs\n"); in add_port()
1462 if (is_rproc_serial(port->portdev->vdev)) in add_port()
1468 port->host_connected = true; in add_port()
1469 else if (!use_multiport(port->portdev)) { in add_port()
1474 err = init_port_console(port); in add_port()
1480 list_add_tail(&port->list, &port->portdev->ports); in add_port()
1488 send_control_msg(port, VIRTIO_CONSOLE_PORT_READY, 1); in add_port()
1496 port->portdev->vdev->index, id); in add_port()
1497 port->debugfs_file = debugfs_create_file(debugfs_name, 0444, in add_port()
1499 port, in add_port()
1505 while ((buf = virtqueue_detach_unused_buf(port->in_vq))) in add_port()
1508 device_destroy(pdrvdata.class, port->dev->devt); in add_port()
1510 cdev_del(port->cdev); in add_port()
1512 kfree(port); in add_port()
1522 struct port *port; in remove_port() local
1524 port = container_of(kref, struct port, kref); in remove_port()
1526 kfree(port); in remove_port()
1529 static void remove_port_data(struct port *port) in remove_port_data() argument
1533 spin_lock_irq(&port->inbuf_lock); in remove_port_data()
1535 discard_port_data(port); in remove_port_data()
1538 while ((buf = virtqueue_detach_unused_buf(port->in_vq))) in remove_port_data()
1540 spin_unlock_irq(&port->inbuf_lock); in remove_port_data()
1542 spin_lock_irq(&port->outvq_lock); in remove_port_data()
1543 reclaim_consumed_buffers(port); in remove_port_data()
1546 while ((buf = virtqueue_detach_unused_buf(port->out_vq))) in remove_port_data()
1548 spin_unlock_irq(&port->outvq_lock); in remove_port_data()
1556 static void unplug_port(struct port *port) in unplug_port() argument
1558 spin_lock_irq(&port->portdev->ports_lock); in unplug_port()
1559 list_del(&port->list); in unplug_port()
1560 spin_unlock_irq(&port->portdev->ports_lock); in unplug_port()
1562 spin_lock_irq(&port->inbuf_lock); in unplug_port()
1563 if (port->guest_connected) { in unplug_port()
1565 send_sigio_to_port(port); in unplug_port()
1568 port->guest_connected = false; in unplug_port()
1569 port->host_connected = false; in unplug_port()
1571 wake_up_interruptible(&port->waitqueue); in unplug_port()
1573 spin_unlock_irq(&port->inbuf_lock); in unplug_port()
1575 if (is_console_port(port)) { in unplug_port()
1577 list_del(&port->cons.list); in unplug_port()
1579 hvc_remove(port->cons.hvc); in unplug_port()
1582 remove_port_data(port); in unplug_port()
1589 port->portdev = NULL; in unplug_port()
1591 sysfs_remove_group(&port->dev->kobj, &port_attribute_group); in unplug_port()
1592 device_destroy(pdrvdata.class, port->dev->devt); in unplug_port()
1593 cdev_del(port->cdev); in unplug_port()
1595 debugfs_remove(port->debugfs_file); in unplug_port()
1596 kfree(port->name); in unplug_port()
1603 kref_put(&port->kref, remove_port); in unplug_port()
1612 struct port *port; in handle_control_message() local
1618 port = find_port_by_id(portdev, virtio32_to_cpu(vdev, cpkt->id)); in handle_control_message()
1619 if (!port && in handle_control_message()
1629 if (port) { in handle_control_message()
1631 "Port %u already added\n", port->id); in handle_control_message()
1632 send_control_msg(port, VIRTIO_CONSOLE_PORT_READY, 1); in handle_control_message()
1646 unplug_port(port); in handle_control_message()
1651 if (is_console_port(port)) in handle_control_message()
1654 init_port_console(port); in handle_control_message()
1667 if (!is_console_port(port)) in handle_control_message()
1672 set_console_size(port, size.rows, size.cols); in handle_control_message()
1674 port->cons.hvc->irq_requested = 1; in handle_control_message()
1675 resize_console(port); in handle_control_message()
1679 port->host_connected = virtio16_to_cpu(vdev, cpkt->value); in handle_control_message()
1680 wake_up_interruptible(&port->waitqueue); in handle_control_message()
1686 spin_lock_irq(&port->outvq_lock); in handle_control_message()
1687 reclaim_consumed_buffers(port); in handle_control_message()
1688 spin_unlock_irq(&port->outvq_lock); in handle_control_message()
1694 spin_lock_irq(&port->inbuf_lock); in handle_control_message()
1695 send_sigio_to_port(port); in handle_control_message()
1696 spin_unlock_irq(&port->inbuf_lock); in handle_control_message()
1703 if (port->name) in handle_control_message()
1712 port->name = kmalloc(name_size, GFP_KERNEL); in handle_control_message()
1713 if (!port->name) { in handle_control_message()
1714 dev_err(port->dev, in handle_control_message()
1718 strncpy(port->name, buf->buf + buf->offset + sizeof(*cpkt), in handle_control_message()
1720 port->name[name_size - 1] = 0; in handle_control_message()
1726 err = sysfs_create_group(&port->dev->kobj, in handle_control_message()
1729 dev_err(port->dev, in handle_control_message()
1738 kobject_uevent(&port->dev->kobj, KOBJ_CHANGE); in handle_control_message()
1775 struct port *port; in out_intr() local
1777 port = find_port_by_vq(vq->vdev->priv, vq); in out_intr()
1778 if (!port) in out_intr()
1781 wake_up_interruptible(&port->waitqueue); in out_intr()
1786 struct port *port; in in_intr() local
1789 port = find_port_by_vq(vq->vdev->priv, vq); in in_intr()
1790 if (!port) in in_intr()
1793 spin_lock_irqsave(&port->inbuf_lock, flags); in in_intr()
1794 port->inbuf = get_inbuf(port); in in_intr()
1813 if (!port->guest_connected && !is_rproc_serial(port->portdev->vdev)) in in_intr()
1814 discard_port_data(port); in in_intr()
1817 send_sigio_to_port(port); in in_intr()
1819 spin_unlock_irqrestore(&port->inbuf_lock, flags); in in_intr()
1821 wake_up_interruptible(&port->waitqueue); in in_intr()
1823 if (is_console_port(port) && hvc_poll(port->cons.hvc)) in in_intr()
1852 struct port *port; in config_work_handler() local
1859 port = find_port_by_id(portdev, 0); in config_work_handler()
1860 set_console_size(port, rows, cols); in config_work_handler()
1869 resize_console(port); in config_work_handler()
2117 struct port *port, *port2; in virtcons_remove() local
2133 list_for_each_entry_safe(port, port2, &portdev->ports, list) in virtcons_remove()
2134 unplug_port(port); in virtcons_remove()
2175 struct port *port; in virtcons_freeze() local
2191 list_for_each_entry(port, &portdev->ports, list) { in virtcons_freeze()
2192 virtqueue_disable_cb(port->in_vq); in virtcons_freeze()
2193 virtqueue_disable_cb(port->out_vq); in virtcons_freeze()
2198 port->host_connected = false; in virtcons_freeze()
2199 remove_port_data(port); in virtcons_freeze()
2209 struct port *port; in virtcons_restore() local
2223 list_for_each_entry(port, &portdev->ports, list) { in virtcons_restore()
2224 port->in_vq = portdev->in_vqs[port->id]; in virtcons_restore()
2225 port->out_vq = portdev->out_vqs[port->id]; in virtcons_restore()
2227 fill_queue(port->in_vq, &port->inbuf_lock); in virtcons_restore()
2230 send_control_msg(port, VIRTIO_CONSOLE_PORT_READY, 1); in virtcons_restore()
2236 if (port->guest_connected) in virtcons_restore()
2237 send_control_msg(port, VIRTIO_CONSOLE_PORT_OPEN, 1); in virtcons_restore()