serdev: implement get/set tiocm
Add method for getting and setting tiocm. Acked-by: Pavel Machek <pavel@ucw.cz> Acked-by: Rob Herring <robh@kernel.org> Signed-off-by: Sebastian Reichel <sre@kernel.org> Acked-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> Signed-off-by: Marcel Holtmann <marcel@holtmann.org>hifive-unleashed-5.1
parent
b3f80c8f75
commit
5659dab26f
|
@ -184,6 +184,28 @@ void serdev_device_wait_until_sent(struct serdev_device *serdev, long timeout)
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(serdev_device_wait_until_sent);
|
EXPORT_SYMBOL_GPL(serdev_device_wait_until_sent);
|
||||||
|
|
||||||
|
int serdev_device_get_tiocm(struct serdev_device *serdev)
|
||||||
|
{
|
||||||
|
struct serdev_controller *ctrl = serdev->ctrl;
|
||||||
|
|
||||||
|
if (!ctrl || !ctrl->ops->get_tiocm)
|
||||||
|
return -ENOTSUPP;
|
||||||
|
|
||||||
|
return ctrl->ops->get_tiocm(ctrl);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(serdev_device_get_tiocm);
|
||||||
|
|
||||||
|
int serdev_device_set_tiocm(struct serdev_device *serdev, int set, int clear)
|
||||||
|
{
|
||||||
|
struct serdev_controller *ctrl = serdev->ctrl;
|
||||||
|
|
||||||
|
if (!ctrl || !ctrl->ops->set_tiocm)
|
||||||
|
return -ENOTSUPP;
|
||||||
|
|
||||||
|
return ctrl->ops->set_tiocm(ctrl, set, clear);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(serdev_device_set_tiocm);
|
||||||
|
|
||||||
static int serdev_drv_probe(struct device *dev)
|
static int serdev_drv_probe(struct device *dev)
|
||||||
{
|
{
|
||||||
const struct serdev_device_driver *sdrv = to_serdev_device_driver(dev->driver);
|
const struct serdev_device_driver *sdrv = to_serdev_device_driver(dev->driver);
|
||||||
|
|
|
@ -176,6 +176,28 @@ static void ttyport_wait_until_sent(struct serdev_controller *ctrl, long timeout
|
||||||
tty_wait_until_sent(tty, timeout);
|
tty_wait_until_sent(tty, timeout);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int ttyport_get_tiocm(struct serdev_controller *ctrl)
|
||||||
|
{
|
||||||
|
struct serport *serport = serdev_controller_get_drvdata(ctrl);
|
||||||
|
struct tty_struct *tty = serport->tty;
|
||||||
|
|
||||||
|
if (!tty->ops->tiocmget)
|
||||||
|
return -ENOTSUPP;
|
||||||
|
|
||||||
|
return tty->driver->ops->tiocmget(tty);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ttyport_set_tiocm(struct serdev_controller *ctrl, unsigned int set, unsigned int clear)
|
||||||
|
{
|
||||||
|
struct serport *serport = serdev_controller_get_drvdata(ctrl);
|
||||||
|
struct tty_struct *tty = serport->tty;
|
||||||
|
|
||||||
|
if (!tty->ops->tiocmset)
|
||||||
|
return -ENOTSUPP;
|
||||||
|
|
||||||
|
return tty->driver->ops->tiocmset(tty, set, clear);
|
||||||
|
}
|
||||||
|
|
||||||
static const struct serdev_controller_ops ctrl_ops = {
|
static const struct serdev_controller_ops ctrl_ops = {
|
||||||
.write_buf = ttyport_write_buf,
|
.write_buf = ttyport_write_buf,
|
||||||
.write_flush = ttyport_write_flush,
|
.write_flush = ttyport_write_flush,
|
||||||
|
@ -185,6 +207,8 @@ static const struct serdev_controller_ops ctrl_ops = {
|
||||||
.set_flow_control = ttyport_set_flow_control,
|
.set_flow_control = ttyport_set_flow_control,
|
||||||
.set_baudrate = ttyport_set_baudrate,
|
.set_baudrate = ttyport_set_baudrate,
|
||||||
.wait_until_sent = ttyport_wait_until_sent,
|
.wait_until_sent = ttyport_wait_until_sent,
|
||||||
|
.get_tiocm = ttyport_get_tiocm,
|
||||||
|
.set_tiocm = ttyport_set_tiocm,
|
||||||
};
|
};
|
||||||
|
|
||||||
struct device *serdev_tty_port_register(struct tty_port *port,
|
struct device *serdev_tty_port_register(struct tty_port *port,
|
||||||
|
|
|
@ -15,6 +15,7 @@
|
||||||
|
|
||||||
#include <linux/types.h>
|
#include <linux/types.h>
|
||||||
#include <linux/device.h>
|
#include <linux/device.h>
|
||||||
|
#include <linux/termios.h>
|
||||||
|
|
||||||
struct serdev_controller;
|
struct serdev_controller;
|
||||||
struct serdev_device;
|
struct serdev_device;
|
||||||
|
@ -82,6 +83,8 @@ struct serdev_controller_ops {
|
||||||
void (*set_flow_control)(struct serdev_controller *, bool);
|
void (*set_flow_control)(struct serdev_controller *, bool);
|
||||||
unsigned int (*set_baudrate)(struct serdev_controller *, unsigned int);
|
unsigned int (*set_baudrate)(struct serdev_controller *, unsigned int);
|
||||||
void (*wait_until_sent)(struct serdev_controller *, long);
|
void (*wait_until_sent)(struct serdev_controller *, long);
|
||||||
|
int (*get_tiocm)(struct serdev_controller *);
|
||||||
|
int (*set_tiocm)(struct serdev_controller *, unsigned int, unsigned int);
|
||||||
};
|
};
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -188,6 +191,8 @@ void serdev_device_close(struct serdev_device *);
|
||||||
unsigned int serdev_device_set_baudrate(struct serdev_device *, unsigned int);
|
unsigned int serdev_device_set_baudrate(struct serdev_device *, unsigned int);
|
||||||
void serdev_device_set_flow_control(struct serdev_device *, bool);
|
void serdev_device_set_flow_control(struct serdev_device *, bool);
|
||||||
void serdev_device_wait_until_sent(struct serdev_device *, long);
|
void serdev_device_wait_until_sent(struct serdev_device *, long);
|
||||||
|
int serdev_device_get_tiocm(struct serdev_device *);
|
||||||
|
int serdev_device_set_tiocm(struct serdev_device *, int, int);
|
||||||
int serdev_device_write_buf(struct serdev_device *, const unsigned char *, size_t);
|
int serdev_device_write_buf(struct serdev_device *, const unsigned char *, size_t);
|
||||||
void serdev_device_write_flush(struct serdev_device *);
|
void serdev_device_write_flush(struct serdev_device *);
|
||||||
int serdev_device_write_room(struct serdev_device *);
|
int serdev_device_write_room(struct serdev_device *);
|
||||||
|
@ -226,6 +231,14 @@ static inline unsigned int serdev_device_set_baudrate(struct serdev_device *sdev
|
||||||
}
|
}
|
||||||
static inline void serdev_device_set_flow_control(struct serdev_device *sdev, bool enable) {}
|
static inline void serdev_device_set_flow_control(struct serdev_device *sdev, bool enable) {}
|
||||||
static inline void serdev_device_wait_until_sent(struct serdev_device *sdev, long timeout) {}
|
static inline void serdev_device_wait_until_sent(struct serdev_device *sdev, long timeout) {}
|
||||||
|
static inline int serdev_device_get_tiocm(struct serdev_device *serdev)
|
||||||
|
{
|
||||||
|
return -ENOTSUPP;
|
||||||
|
}
|
||||||
|
static inline int serdev_device_set_tiocm(struct serdev_device *serdev, int set, int clear)
|
||||||
|
{
|
||||||
|
return -ENOTSUPP;
|
||||||
|
}
|
||||||
static inline int serdev_device_write_buf(struct serdev_device *sdev, const unsigned char *buf, size_t count)
|
static inline int serdev_device_write_buf(struct serdev_device *sdev, const unsigned char *buf, size_t count)
|
||||||
{
|
{
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
|
|
Loading…
Reference in New Issue