1f141cfe3SKrzysztof Kozlowski // SPDX-License-Identifier: GPL-2.0-or-later
29961127dSVincent Cuissard /*
39961127dSVincent Cuissard * Copyright (C) 2015, Marvell International Ltd.
49961127dSVincent Cuissard *
5f141cfe3SKrzysztof Kozlowski * Inspired (hugely) by HCI LDISC implementation in Bluetooth.
69961127dSVincent Cuissard *
79961127dSVincent Cuissard * Copyright (C) 2000-2001 Qualcomm Incorporated
89961127dSVincent Cuissard * Copyright (C) 2002-2003 Maxim Krasnyansky <maxk@qualcomm.com>
99961127dSVincent Cuissard * Copyright (C) 2004-2005 Marcel Holtmann <marcel@holtmann.org>
109961127dSVincent Cuissard */
119961127dSVincent Cuissard
129961127dSVincent Cuissard #include <linux/module.h>
139961127dSVincent Cuissard
149961127dSVincent Cuissard #include <linux/kernel.h>
159961127dSVincent Cuissard #include <linux/init.h>
169961127dSVincent Cuissard #include <linux/types.h>
179961127dSVincent Cuissard #include <linux/fcntl.h>
189961127dSVincent Cuissard #include <linux/interrupt.h>
199961127dSVincent Cuissard #include <linux/ptrace.h>
209961127dSVincent Cuissard #include <linux/poll.h>
219961127dSVincent Cuissard
229961127dSVincent Cuissard #include <linux/slab.h>
239961127dSVincent Cuissard #include <linux/tty.h>
249961127dSVincent Cuissard #include <linux/errno.h>
259961127dSVincent Cuissard #include <linux/string.h>
269961127dSVincent Cuissard #include <linux/signal.h>
279961127dSVincent Cuissard #include <linux/ioctl.h>
289961127dSVincent Cuissard #include <linux/skbuff.h>
299961127dSVincent Cuissard
309961127dSVincent Cuissard #include <net/nfc/nci.h>
319961127dSVincent Cuissard #include <net/nfc/nci_core.h>
329961127dSVincent Cuissard
339961127dSVincent Cuissard /* TX states */
349961127dSVincent Cuissard #define NCI_UART_SENDING 1
359961127dSVincent Cuissard #define NCI_UART_TX_WAKEUP 2
369961127dSVincent Cuissard
379961127dSVincent Cuissard static struct nci_uart *nci_uart_drivers[NCI_UART_DRIVER_MAX];
389961127dSVincent Cuissard
nci_uart_dequeue(struct nci_uart * nu)399961127dSVincent Cuissard static inline struct sk_buff *nci_uart_dequeue(struct nci_uart *nu)
409961127dSVincent Cuissard {
419961127dSVincent Cuissard struct sk_buff *skb = nu->tx_skb;
429961127dSVincent Cuissard
439961127dSVincent Cuissard if (!skb)
449961127dSVincent Cuissard skb = skb_dequeue(&nu->tx_q);
459961127dSVincent Cuissard else
469961127dSVincent Cuissard nu->tx_skb = NULL;
479961127dSVincent Cuissard
489961127dSVincent Cuissard return skb;
499961127dSVincent Cuissard }
509961127dSVincent Cuissard
nci_uart_queue_empty(struct nci_uart * nu)519961127dSVincent Cuissard static inline int nci_uart_queue_empty(struct nci_uart *nu)
529961127dSVincent Cuissard {
539961127dSVincent Cuissard if (nu->tx_skb)
549961127dSVincent Cuissard return 0;
559961127dSVincent Cuissard
569961127dSVincent Cuissard return skb_queue_empty(&nu->tx_q);
579961127dSVincent Cuissard }
589961127dSVincent Cuissard
nci_uart_tx_wakeup(struct nci_uart * nu)599961127dSVincent Cuissard static int nci_uart_tx_wakeup(struct nci_uart *nu)
609961127dSVincent Cuissard {
619961127dSVincent Cuissard if (test_and_set_bit(NCI_UART_SENDING, &nu->tx_state)) {
629961127dSVincent Cuissard set_bit(NCI_UART_TX_WAKEUP, &nu->tx_state);
639961127dSVincent Cuissard return 0;
649961127dSVincent Cuissard }
659961127dSVincent Cuissard
669961127dSVincent Cuissard schedule_work(&nu->write_work);
679961127dSVincent Cuissard
689961127dSVincent Cuissard return 0;
699961127dSVincent Cuissard }
709961127dSVincent Cuissard
nci_uart_write_work(struct work_struct * work)719961127dSVincent Cuissard static void nci_uart_write_work(struct work_struct *work)
729961127dSVincent Cuissard {
739961127dSVincent Cuissard struct nci_uart *nu = container_of(work, struct nci_uart, write_work);
749961127dSVincent Cuissard struct tty_struct *tty = nu->tty;
759961127dSVincent Cuissard struct sk_buff *skb;
769961127dSVincent Cuissard
779961127dSVincent Cuissard restart:
789961127dSVincent Cuissard clear_bit(NCI_UART_TX_WAKEUP, &nu->tx_state);
799961127dSVincent Cuissard
809961127dSVincent Cuissard if (nu->ops.tx_start)
819961127dSVincent Cuissard nu->ops.tx_start(nu);
829961127dSVincent Cuissard
839961127dSVincent Cuissard while ((skb = nci_uart_dequeue(nu))) {
849961127dSVincent Cuissard int len;
859961127dSVincent Cuissard
869961127dSVincent Cuissard set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
879961127dSVincent Cuissard len = tty->ops->write(tty, skb->data, skb->len);
889961127dSVincent Cuissard skb_pull(skb, len);
899961127dSVincent Cuissard if (skb->len) {
909961127dSVincent Cuissard nu->tx_skb = skb;
919961127dSVincent Cuissard break;
929961127dSVincent Cuissard }
939961127dSVincent Cuissard kfree_skb(skb);
949961127dSVincent Cuissard }
959961127dSVincent Cuissard
969961127dSVincent Cuissard if (test_bit(NCI_UART_TX_WAKEUP, &nu->tx_state))
979961127dSVincent Cuissard goto restart;
989961127dSVincent Cuissard
999961127dSVincent Cuissard if (nu->ops.tx_done && nci_uart_queue_empty(nu))
1009961127dSVincent Cuissard nu->ops.tx_done(nu);
1019961127dSVincent Cuissard
1029961127dSVincent Cuissard clear_bit(NCI_UART_SENDING, &nu->tx_state);
1039961127dSVincent Cuissard }
1049961127dSVincent Cuissard
nci_uart_set_driver(struct tty_struct * tty,unsigned int driver)1059961127dSVincent Cuissard static int nci_uart_set_driver(struct tty_struct *tty, unsigned int driver)
1069961127dSVincent Cuissard {
1079961127dSVincent Cuissard struct nci_uart *nu = NULL;
1089961127dSVincent Cuissard int ret;
1099961127dSVincent Cuissard
1109961127dSVincent Cuissard if (driver >= NCI_UART_DRIVER_MAX)
1119961127dSVincent Cuissard return -EINVAL;
1129961127dSVincent Cuissard
1139961127dSVincent Cuissard if (!nci_uart_drivers[driver])
1149961127dSVincent Cuissard return -ENOENT;
1159961127dSVincent Cuissard
1169961127dSVincent Cuissard nu = kzalloc(sizeof(*nu), GFP_KERNEL);
1179961127dSVincent Cuissard if (!nu)
1189961127dSVincent Cuissard return -ENOMEM;
1199961127dSVincent Cuissard
1209961127dSVincent Cuissard memcpy(nu, nci_uart_drivers[driver], sizeof(struct nci_uart));
1219961127dSVincent Cuissard nu->tty = tty;
1229961127dSVincent Cuissard tty->disc_data = nu;
1239961127dSVincent Cuissard skb_queue_head_init(&nu->tx_q);
1249961127dSVincent Cuissard INIT_WORK(&nu->write_work, nci_uart_write_work);
1259961127dSVincent Cuissard spin_lock_init(&nu->rx_lock);
1269961127dSVincent Cuissard
1279961127dSVincent Cuissard ret = nu->ops.open(nu);
1289961127dSVincent Cuissard if (ret) {
1299961127dSVincent Cuissard tty->disc_data = NULL;
1309961127dSVincent Cuissard kfree(nu);
1319961127dSVincent Cuissard } else if (!try_module_get(nu->owner)) {
1329961127dSVincent Cuissard nu->ops.close(nu);
1339961127dSVincent Cuissard tty->disc_data = NULL;
1349961127dSVincent Cuissard kfree(nu);
1359961127dSVincent Cuissard return -ENOENT;
1369961127dSVincent Cuissard }
1379961127dSVincent Cuissard return ret;
1389961127dSVincent Cuissard }
1399961127dSVincent Cuissard
1409961127dSVincent Cuissard /* ------ LDISC part ------ */
1419961127dSVincent Cuissard
1429961127dSVincent Cuissard /* nci_uart_tty_open
1439961127dSVincent Cuissard *
1449961127dSVincent Cuissard * Called when line discipline changed to NCI_UART.
1459961127dSVincent Cuissard *
1469961127dSVincent Cuissard * Arguments:
1479961127dSVincent Cuissard * tty pointer to tty info structure
1489961127dSVincent Cuissard * Return Value:
1499961127dSVincent Cuissard * 0 if success, otherwise error code
1509961127dSVincent Cuissard */
nci_uart_tty_open(struct tty_struct * tty)1519961127dSVincent Cuissard static int nci_uart_tty_open(struct tty_struct *tty)
1529961127dSVincent Cuissard {
1539961127dSVincent Cuissard /* Error if the tty has no write op instead of leaving an exploitable
1549961127dSVincent Cuissard * hole
1559961127dSVincent Cuissard */
1569961127dSVincent Cuissard if (!tty->ops->write)
1579961127dSVincent Cuissard return -EOPNOTSUPP;
1589961127dSVincent Cuissard
1599961127dSVincent Cuissard tty->disc_data = NULL;
1609961127dSVincent Cuissard tty->receive_room = 65536;
1619961127dSVincent Cuissard
162582e20a0SPeter Hurley /* Flush any pending characters in the driver */
1639961127dSVincent Cuissard tty_driver_flush_buffer(tty);
1649961127dSVincent Cuissard
1659961127dSVincent Cuissard return 0;
1669961127dSVincent Cuissard }
1679961127dSVincent Cuissard
1689961127dSVincent Cuissard /* nci_uart_tty_close()
1699961127dSVincent Cuissard *
1709961127dSVincent Cuissard * Called when the line discipline is changed to something
1719961127dSVincent Cuissard * else, the tty is closed, or the tty detects a hangup.
1729961127dSVincent Cuissard */
nci_uart_tty_close(struct tty_struct * tty)1739961127dSVincent Cuissard static void nci_uart_tty_close(struct tty_struct *tty)
1749961127dSVincent Cuissard {
1758a76d8b0SJiri Slaby struct nci_uart *nu = tty->disc_data;
1769961127dSVincent Cuissard
1779961127dSVincent Cuissard /* Detach from the tty */
1789961127dSVincent Cuissard tty->disc_data = NULL;
1799961127dSVincent Cuissard
1809961127dSVincent Cuissard if (!nu)
1819961127dSVincent Cuissard return;
1829961127dSVincent Cuissard
1839961127dSVincent Cuissard kfree_skb(nu->tx_skb);
1849961127dSVincent Cuissard kfree_skb(nu->rx_skb);
1859961127dSVincent Cuissard
1869961127dSVincent Cuissard skb_queue_purge(&nu->tx_q);
1879961127dSVincent Cuissard
1889961127dSVincent Cuissard nu->ops.close(nu);
1899961127dSVincent Cuissard nu->tty = NULL;
1909961127dSVincent Cuissard module_put(nu->owner);
1919961127dSVincent Cuissard
1929961127dSVincent Cuissard cancel_work_sync(&nu->write_work);
1939961127dSVincent Cuissard
1949961127dSVincent Cuissard kfree(nu);
1959961127dSVincent Cuissard }
1969961127dSVincent Cuissard
1979961127dSVincent Cuissard /* nci_uart_tty_wakeup()
1989961127dSVincent Cuissard *
1999961127dSVincent Cuissard * Callback for transmit wakeup. Called when low level
2009961127dSVincent Cuissard * device driver can accept more send data.
2019961127dSVincent Cuissard *
2029961127dSVincent Cuissard * Arguments: tty pointer to associated tty instance data
2039961127dSVincent Cuissard * Return Value: None
2049961127dSVincent Cuissard */
nci_uart_tty_wakeup(struct tty_struct * tty)2059961127dSVincent Cuissard static void nci_uart_tty_wakeup(struct tty_struct *tty)
2069961127dSVincent Cuissard {
2078a76d8b0SJiri Slaby struct nci_uart *nu = tty->disc_data;
2089961127dSVincent Cuissard
2099961127dSVincent Cuissard if (!nu)
2109961127dSVincent Cuissard return;
2119961127dSVincent Cuissard
2129961127dSVincent Cuissard clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
2139961127dSVincent Cuissard
2149961127dSVincent Cuissard if (tty != nu->tty)
2159961127dSVincent Cuissard return;
2169961127dSVincent Cuissard
2179961127dSVincent Cuissard nci_uart_tx_wakeup(nu);
2189961127dSVincent Cuissard }
2199961127dSVincent Cuissard
220c2a5a45cSJiri Slaby /* -- Default recv_buf handler --
221c2a5a45cSJiri Slaby *
222c2a5a45cSJiri Slaby * This handler supposes that NCI frames are sent over UART link without any
223c2a5a45cSJiri Slaby * framing. It reads NCI header, retrieve the packet size and once all packet
224c2a5a45cSJiri Slaby * bytes are received it passes it to nci_uart driver for processing.
225c2a5a45cSJiri Slaby */
nci_uart_default_recv_buf(struct nci_uart * nu,const u8 * data,int count)226c2a5a45cSJiri Slaby static int nci_uart_default_recv_buf(struct nci_uart *nu, const u8 *data,
227c2a5a45cSJiri Slaby int count)
228c2a5a45cSJiri Slaby {
229c2a5a45cSJiri Slaby int chunk_len;
230c2a5a45cSJiri Slaby
231c2a5a45cSJiri Slaby if (!nu->ndev) {
232c2a5a45cSJiri Slaby nfc_err(nu->tty->dev,
233c2a5a45cSJiri Slaby "receive data from tty but no NCI dev is attached yet, drop buffer\n");
234c2a5a45cSJiri Slaby return 0;
235c2a5a45cSJiri Slaby }
236c2a5a45cSJiri Slaby
237c2a5a45cSJiri Slaby /* Decode all incoming data in packets
238c2a5a45cSJiri Slaby * and enqueue then for processing.
239c2a5a45cSJiri Slaby */
240c2a5a45cSJiri Slaby while (count > 0) {
241c2a5a45cSJiri Slaby /* If this is the first data of a packet, allocate a buffer */
242c2a5a45cSJiri Slaby if (!nu->rx_skb) {
243c2a5a45cSJiri Slaby nu->rx_packet_len = -1;
244c2a5a45cSJiri Slaby nu->rx_skb = nci_skb_alloc(nu->ndev,
245c2a5a45cSJiri Slaby NCI_MAX_PACKET_SIZE,
246c2a5a45cSJiri Slaby GFP_ATOMIC);
247c2a5a45cSJiri Slaby if (!nu->rx_skb)
248c2a5a45cSJiri Slaby return -ENOMEM;
249c2a5a45cSJiri Slaby }
250c2a5a45cSJiri Slaby
251c2a5a45cSJiri Slaby /* Eat byte after byte till full packet header is received */
252c2a5a45cSJiri Slaby if (nu->rx_skb->len < NCI_CTRL_HDR_SIZE) {
253c2a5a45cSJiri Slaby skb_put_u8(nu->rx_skb, *data++);
254c2a5a45cSJiri Slaby --count;
255c2a5a45cSJiri Slaby continue;
256c2a5a45cSJiri Slaby }
257c2a5a45cSJiri Slaby
258c2a5a45cSJiri Slaby /* Header was received but packet len was not read */
259c2a5a45cSJiri Slaby if (nu->rx_packet_len < 0)
260c2a5a45cSJiri Slaby nu->rx_packet_len = NCI_CTRL_HDR_SIZE +
261c2a5a45cSJiri Slaby nci_plen(nu->rx_skb->data);
262c2a5a45cSJiri Slaby
263c2a5a45cSJiri Slaby /* Compute how many bytes are missing and how many bytes can
264c2a5a45cSJiri Slaby * be consumed.
265c2a5a45cSJiri Slaby */
266c2a5a45cSJiri Slaby chunk_len = nu->rx_packet_len - nu->rx_skb->len;
267c2a5a45cSJiri Slaby if (count < chunk_len)
268c2a5a45cSJiri Slaby chunk_len = count;
269c2a5a45cSJiri Slaby skb_put_data(nu->rx_skb, data, chunk_len);
270c2a5a45cSJiri Slaby data += chunk_len;
271c2a5a45cSJiri Slaby count -= chunk_len;
272c2a5a45cSJiri Slaby
2739d31d233SLinus Torvalds /* Check if packet is fully received */
274c2a5a45cSJiri Slaby if (nu->rx_packet_len == nu->rx_skb->len) {
275c2a5a45cSJiri Slaby /* Pass RX packet to driver */
276c2a5a45cSJiri Slaby if (nu->ops.recv(nu, nu->rx_skb) != 0)
277c2a5a45cSJiri Slaby nfc_err(nu->tty->dev, "corrupted RX packet\n");
278c2a5a45cSJiri Slaby /* Next packet will be a new one */
279c2a5a45cSJiri Slaby nu->rx_skb = NULL;
280c2a5a45cSJiri Slaby }
281c2a5a45cSJiri Slaby }
282c2a5a45cSJiri Slaby
283c2a5a45cSJiri Slaby return 0;
284c2a5a45cSJiri Slaby }
285c2a5a45cSJiri Slaby
2869961127dSVincent Cuissard /* nci_uart_tty_receive()
2879961127dSVincent Cuissard *
2889961127dSVincent Cuissard * Called by tty low level driver when receive data is
2899961127dSVincent Cuissard * available.
2909961127dSVincent Cuissard *
291d3295869SZheng Yongjun * Arguments: tty pointer to tty instance data
2929961127dSVincent Cuissard * data pointer to received data
2939961127dSVincent Cuissard * flags pointer to flags for data
2949961127dSVincent Cuissard * count count of received data in bytes
2959961127dSVincent Cuissard *
2969961127dSVincent Cuissard * Return Value: None
2979961127dSVincent Cuissard */
nci_uart_tty_receive(struct tty_struct * tty,const u8 * data,const u8 * flags,size_t count)2989961127dSVincent Cuissard static void nci_uart_tty_receive(struct tty_struct *tty, const u8 *data,
299892bc209SJiri Slaby (SUSE) const u8 *flags, size_t count)
3009961127dSVincent Cuissard {
3018a76d8b0SJiri Slaby struct nci_uart *nu = tty->disc_data;
3029961127dSVincent Cuissard
3039961127dSVincent Cuissard if (!nu || tty != nu->tty)
3049961127dSVincent Cuissard return;
3059961127dSVincent Cuissard
3069961127dSVincent Cuissard spin_lock(&nu->rx_lock);
307c2a5a45cSJiri Slaby nci_uart_default_recv_buf(nu, data, count);
3089961127dSVincent Cuissard spin_unlock(&nu->rx_lock);
3099961127dSVincent Cuissard
3109961127dSVincent Cuissard tty_unthrottle(tty);
3119961127dSVincent Cuissard }
3129961127dSVincent Cuissard
3139961127dSVincent Cuissard /* nci_uart_tty_ioctl()
3149961127dSVincent Cuissard *
3159961127dSVincent Cuissard * Process IOCTL system call for the tty device.
3169961127dSVincent Cuissard *
3179961127dSVincent Cuissard * Arguments:
3189961127dSVincent Cuissard *
3199961127dSVincent Cuissard * tty pointer to tty instance data
3209961127dSVincent Cuissard * cmd IOCTL command code
3219961127dSVincent Cuissard * arg argument for IOCTL call (cmd dependent)
3229961127dSVincent Cuissard *
3239961127dSVincent Cuissard * Return Value: Command dependent
3249961127dSVincent Cuissard */
nci_uart_tty_ioctl(struct tty_struct * tty,unsigned int cmd,unsigned long arg)325d78328bcSJiri Slaby static int nci_uart_tty_ioctl(struct tty_struct *tty, unsigned int cmd,
326d78328bcSJiri Slaby unsigned long arg)
3279961127dSVincent Cuissard {
3288a76d8b0SJiri Slaby struct nci_uart *nu = tty->disc_data;
3299961127dSVincent Cuissard int err = 0;
3309961127dSVincent Cuissard
3319961127dSVincent Cuissard switch (cmd) {
3329961127dSVincent Cuissard case NCIUARTSETDRIVER:
3339961127dSVincent Cuissard if (!nu)
3349961127dSVincent Cuissard return nci_uart_set_driver(tty, (unsigned int)arg);
3359961127dSVincent Cuissard else
3369961127dSVincent Cuissard return -EBUSY;
3379961127dSVincent Cuissard break;
3389961127dSVincent Cuissard default:
3397c783601SJiri Slaby err = n_tty_ioctl_helper(tty, cmd, arg);
3409961127dSVincent Cuissard break;
3419961127dSVincent Cuissard }
3429961127dSVincent Cuissard
3439961127dSVincent Cuissard return err;
3449961127dSVincent Cuissard }
3459961127dSVincent Cuissard
3469961127dSVincent Cuissard /* We don't provide read/write/poll interface for user space. */
nci_uart_tty_read(struct tty_struct * tty,struct file * file,u8 * buf,size_t nr,void ** cookie,unsigned long offset)3479961127dSVincent Cuissard static ssize_t nci_uart_tty_read(struct tty_struct *tty, struct file *file,
348*49b8220cSJiri Slaby (SUSE) u8 *buf, size_t nr, void **cookie,
349*49b8220cSJiri Slaby (SUSE) unsigned long offset)
3509961127dSVincent Cuissard {
3519961127dSVincent Cuissard return 0;
3529961127dSVincent Cuissard }
3539961127dSVincent Cuissard
nci_uart_tty_write(struct tty_struct * tty,struct file * file,const u8 * data,size_t count)3549961127dSVincent Cuissard static ssize_t nci_uart_tty_write(struct tty_struct *tty, struct file *file,
355*49b8220cSJiri Slaby (SUSE) const u8 *data, size_t count)
3569961127dSVincent Cuissard {
3579961127dSVincent Cuissard return 0;
3589961127dSVincent Cuissard }
3599961127dSVincent Cuissard
nci_uart_send(struct nci_uart * nu,struct sk_buff * skb)3609961127dSVincent Cuissard static int nci_uart_send(struct nci_uart *nu, struct sk_buff *skb)
3619961127dSVincent Cuissard {
3629961127dSVincent Cuissard /* Queue TX packet */
3639961127dSVincent Cuissard skb_queue_tail(&nu->tx_q, skb);
3649961127dSVincent Cuissard
3659961127dSVincent Cuissard /* Try to start TX (if possible) */
3669961127dSVincent Cuissard nci_uart_tx_wakeup(nu);
3679961127dSVincent Cuissard
3689961127dSVincent Cuissard return 0;
3699961127dSVincent Cuissard }
3709961127dSVincent Cuissard
nci_uart_register(struct nci_uart * nu)3719961127dSVincent Cuissard int nci_uart_register(struct nci_uart *nu)
3729961127dSVincent Cuissard {
3739961127dSVincent Cuissard if (!nu || !nu->ops.open ||
3749961127dSVincent Cuissard !nu->ops.recv || !nu->ops.close)
3759961127dSVincent Cuissard return -EINVAL;
3769961127dSVincent Cuissard
3779961127dSVincent Cuissard /* Set the send callback */
3789961127dSVincent Cuissard nu->ops.send = nci_uart_send;
3799961127dSVincent Cuissard
3809961127dSVincent Cuissard /* Add this driver in the driver list */
381fb77ff4fSVincent Cuissard if (nci_uart_drivers[nu->driver]) {
3829961127dSVincent Cuissard pr_err("driver %d is already registered\n", nu->driver);
3839961127dSVincent Cuissard return -EBUSY;
3849961127dSVincent Cuissard }
3859961127dSVincent Cuissard nci_uart_drivers[nu->driver] = nu;
3869961127dSVincent Cuissard
3879961127dSVincent Cuissard pr_info("NCI uart driver '%s [%d]' registered\n", nu->name, nu->driver);
3889961127dSVincent Cuissard
3899961127dSVincent Cuissard return 0;
3909961127dSVincent Cuissard }
3919961127dSVincent Cuissard EXPORT_SYMBOL_GPL(nci_uart_register);
3929961127dSVincent Cuissard
nci_uart_unregister(struct nci_uart * nu)3939961127dSVincent Cuissard void nci_uart_unregister(struct nci_uart *nu)
3949961127dSVincent Cuissard {
3959961127dSVincent Cuissard pr_info("NCI uart driver '%s [%d]' unregistered\n", nu->name,
3969961127dSVincent Cuissard nu->driver);
3979961127dSVincent Cuissard
3989961127dSVincent Cuissard /* Remove this driver from the driver list */
3999961127dSVincent Cuissard nci_uart_drivers[nu->driver] = NULL;
4009961127dSVincent Cuissard }
4019961127dSVincent Cuissard EXPORT_SYMBOL_GPL(nci_uart_unregister);
4029961127dSVincent Cuissard
nci_uart_set_config(struct nci_uart * nu,int baudrate,int flow_ctrl)4039961127dSVincent Cuissard void nci_uart_set_config(struct nci_uart *nu, int baudrate, int flow_ctrl)
4049961127dSVincent Cuissard {
4059961127dSVincent Cuissard struct ktermios new_termios;
4069961127dSVincent Cuissard
4079961127dSVincent Cuissard if (!nu->tty)
4089961127dSVincent Cuissard return;
4099961127dSVincent Cuissard
4109961127dSVincent Cuissard down_read(&nu->tty->termios_rwsem);
4119961127dSVincent Cuissard new_termios = nu->tty->termios;
4129961127dSVincent Cuissard up_read(&nu->tty->termios_rwsem);
4139961127dSVincent Cuissard tty_termios_encode_baud_rate(&new_termios, baudrate, baudrate);
4149961127dSVincent Cuissard
4159961127dSVincent Cuissard if (flow_ctrl)
4169961127dSVincent Cuissard new_termios.c_cflag |= CRTSCTS;
4179961127dSVincent Cuissard else
4189961127dSVincent Cuissard new_termios.c_cflag &= ~CRTSCTS;
4199961127dSVincent Cuissard
4209961127dSVincent Cuissard tty_set_termios(nu->tty, &new_termios);
4219961127dSVincent Cuissard }
4229961127dSVincent Cuissard EXPORT_SYMBOL_GPL(nci_uart_set_config);
4239961127dSVincent Cuissard
4249961127dSVincent Cuissard static struct tty_ldisc_ops nci_uart_ldisc = {
4259961127dSVincent Cuissard .owner = THIS_MODULE,
426fbadf70aSJiri Slaby .num = N_NCI,
4279961127dSVincent Cuissard .name = "n_nci",
4289961127dSVincent Cuissard .open = nci_uart_tty_open,
4299961127dSVincent Cuissard .close = nci_uart_tty_close,
4309961127dSVincent Cuissard .read = nci_uart_tty_read,
4319961127dSVincent Cuissard .write = nci_uart_tty_write,
4329961127dSVincent Cuissard .receive_buf = nci_uart_tty_receive,
4339961127dSVincent Cuissard .write_wakeup = nci_uart_tty_wakeup,
4349961127dSVincent Cuissard .ioctl = nci_uart_tty_ioctl,
435f0193d3eSAl Viro .compat_ioctl = nci_uart_tty_ioctl,
4369961127dSVincent Cuissard };
4379961127dSVincent Cuissard
nci_uart_init(void)4389961127dSVincent Cuissard static int __init nci_uart_init(void)
4399961127dSVincent Cuissard {
440fbadf70aSJiri Slaby return tty_register_ldisc(&nci_uart_ldisc);
4419961127dSVincent Cuissard }
4429961127dSVincent Cuissard
nci_uart_exit(void)4439961127dSVincent Cuissard static void __exit nci_uart_exit(void)
4449961127dSVincent Cuissard {
445f81ee8b8SJiri Slaby tty_unregister_ldisc(&nci_uart_ldisc);
4469961127dSVincent Cuissard }
4479961127dSVincent Cuissard
4489961127dSVincent Cuissard module_init(nci_uart_init);
4499961127dSVincent Cuissard module_exit(nci_uart_exit);
4509961127dSVincent Cuissard
4519961127dSVincent Cuissard MODULE_AUTHOR("Marvell International Ltd.");
4529961127dSVincent Cuissard MODULE_DESCRIPTION("NFC NCI UART driver");
4539961127dSVincent Cuissard MODULE_LICENSE("GPL");
4549961127dSVincent Cuissard MODULE_ALIAS_LDISC(N_NCI);
455