|
@@ -487,6 +487,8 @@ static struct vio_version vcc_versions[] = {
|
|
|
{ .major = 1, .minor = 0 },
|
|
|
};
|
|
|
|
|
|
+static struct tty_port_operations vcc_port_ops = { 0 };
|
|
|
+
|
|
|
static ssize_t vcc_sysfs_domain_show(struct device *dev,
|
|
|
struct device_attribute *attr,
|
|
|
char *buf)
|
|
@@ -994,6 +996,75 @@ static int vcc_break_ctl(struct tty_struct *tty, int state)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+static int vcc_install(struct tty_driver *driver, struct tty_struct *tty)
|
|
|
+{
|
|
|
+ struct vcc_port *port_vcc;
|
|
|
+ struct tty_port *port_tty;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ if (unlikely(!tty)) {
|
|
|
+ pr_err("VCC: install: Invalid TTY handle\n");
|
|
|
+ return -ENXIO;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (tty->index >= VCC_MAX_PORTS)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ ret = tty_standard_install(driver, tty);
|
|
|
+ if (ret)
|
|
|
+ return ret;
|
|
|
+
|
|
|
+ port_tty = kzalloc(sizeof(struct tty_port), GFP_KERNEL);
|
|
|
+ if (!port_tty)
|
|
|
+ return -ENOMEM;
|
|
|
+
|
|
|
+ port_vcc = vcc_get(tty->index, true);
|
|
|
+ if (!port_vcc) {
|
|
|
+ pr_err("VCC: install: Failed to find VCC port\n");
|
|
|
+ tty->port = NULL;
|
|
|
+ kfree(port_tty);
|
|
|
+ return -ENODEV;
|
|
|
+ }
|
|
|
+
|
|
|
+ tty_port_init(port_tty);
|
|
|
+ port_tty->ops = &vcc_port_ops;
|
|
|
+ tty->port = port_tty;
|
|
|
+
|
|
|
+ port_vcc->tty = tty;
|
|
|
+
|
|
|
+ vcc_put(port_vcc, true);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static void vcc_cleanup(struct tty_struct *tty)
|
|
|
+{
|
|
|
+ struct vcc_port *port;
|
|
|
+
|
|
|
+ if (unlikely(!tty)) {
|
|
|
+ pr_err("VCC: cleanup: Invalid TTY handle\n");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ port = vcc_get(tty->index, true);
|
|
|
+ if (port) {
|
|
|
+ port->tty = NULL;
|
|
|
+
|
|
|
+ if (port->removed) {
|
|
|
+ vcc_table_remove(tty->index);
|
|
|
+ kfree(port->vio.name);
|
|
|
+ kfree(port->domain);
|
|
|
+ kfree(port);
|
|
|
+ } else {
|
|
|
+ vcc_put(port, true);
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ tty_port_destroy(tty->port);
|
|
|
+ kfree(tty->port);
|
|
|
+ tty->port = NULL;
|
|
|
+}
|
|
|
+
|
|
|
static const struct tty_operations vcc_ops = {
|
|
|
.open = vcc_open,
|
|
|
.close = vcc_close,
|
|
@@ -1002,6 +1073,8 @@ static const struct tty_operations vcc_ops = {
|
|
|
.write_room = vcc_write_room,
|
|
|
.chars_in_buffer = vcc_chars_in_buffer,
|
|
|
.break_ctl = vcc_break_ctl,
|
|
|
+ .install = vcc_install,
|
|
|
+ .cleanup = vcc_cleanup,
|
|
|
};
|
|
|
|
|
|
#define VCC_TTY_FLAGS (TTY_DRIVER_DYNAMIC_DEV | TTY_DRIVER_REAL_RAW)
|