1dfc768fbSStefan Wahren /*
2dfc768fbSStefan Wahren * Copyright (c) 2011, 2012, Qualcomm Atheros Communications Inc.
3dfc768fbSStefan Wahren * Copyright (c) 2017, I2SE GmbH
4dfc768fbSStefan Wahren *
5dfc768fbSStefan Wahren * Permission to use, copy, modify, and/or distribute this software
6dfc768fbSStefan Wahren * for any purpose with or without fee is hereby granted, provided
7dfc768fbSStefan Wahren * that the above copyright notice and this permission notice appear
8dfc768fbSStefan Wahren * in all copies.
9dfc768fbSStefan Wahren *
10dfc768fbSStefan Wahren * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
11dfc768fbSStefan Wahren * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
12dfc768fbSStefan Wahren * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL
13dfc768fbSStefan Wahren * THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR
14dfc768fbSStefan Wahren * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM
15dfc768fbSStefan Wahren * LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT,
16dfc768fbSStefan Wahren * NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
17dfc768fbSStefan Wahren * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18dfc768fbSStefan Wahren */
19dfc768fbSStefan Wahren
20dfc768fbSStefan Wahren /* This module implements the Qualcomm Atheros UART protocol for
21dfc768fbSStefan Wahren * kernel-based UART device; it is essentially an Ethernet-to-UART
22dfc768fbSStefan Wahren * serial converter;
23dfc768fbSStefan Wahren */
24dfc768fbSStefan Wahren
25dfc768fbSStefan Wahren #include <linux/device.h>
26dfc768fbSStefan Wahren #include <linux/errno.h>
27dfc768fbSStefan Wahren #include <linux/etherdevice.h>
28dfc768fbSStefan Wahren #include <linux/if_arp.h>
29dfc768fbSStefan Wahren #include <linux/if_ether.h>
30dfc768fbSStefan Wahren #include <linux/jiffies.h>
31dfc768fbSStefan Wahren #include <linux/kernel.h>
32dfc768fbSStefan Wahren #include <linux/module.h>
33dfc768fbSStefan Wahren #include <linux/netdevice.h>
34dfc768fbSStefan Wahren #include <linux/of.h>
35dfc768fbSStefan Wahren #include <linux/of_net.h>
36dfc768fbSStefan Wahren #include <linux/sched.h>
37dfc768fbSStefan Wahren #include <linux/serdev.h>
38dfc768fbSStefan Wahren #include <linux/skbuff.h>
39dfc768fbSStefan Wahren #include <linux/types.h>
40dfc768fbSStefan Wahren
41dfc768fbSStefan Wahren #include "qca_7k_common.h"
42dfc768fbSStefan Wahren
43dfc768fbSStefan Wahren #define QCAUART_DRV_VERSION "0.1.0"
44dfc768fbSStefan Wahren #define QCAUART_DRV_NAME "qcauart"
45dfc768fbSStefan Wahren #define QCAUART_TX_TIMEOUT (1 * HZ)
46dfc768fbSStefan Wahren
47dfc768fbSStefan Wahren struct qcauart {
48dfc768fbSStefan Wahren struct net_device *net_dev;
49dfc768fbSStefan Wahren spinlock_t lock; /* transmit lock */
50dfc768fbSStefan Wahren struct work_struct tx_work; /* Flushes transmit buffer */
51dfc768fbSStefan Wahren
52dfc768fbSStefan Wahren struct serdev_device *serdev;
53dfc768fbSStefan Wahren struct qcafrm_handle frm_handle;
54dfc768fbSStefan Wahren struct sk_buff *rx_skb;
55dfc768fbSStefan Wahren
56dfc768fbSStefan Wahren unsigned char *tx_head; /* pointer to next XMIT byte */
57dfc768fbSStefan Wahren int tx_left; /* bytes left in XMIT queue */
58dfc768fbSStefan Wahren unsigned char *tx_buffer;
59dfc768fbSStefan Wahren };
60dfc768fbSStefan Wahren
61dfc768fbSStefan Wahren static int
qca_tty_receive(struct serdev_device * serdev,const unsigned char * data,size_t count)62dfc768fbSStefan Wahren qca_tty_receive(struct serdev_device *serdev, const unsigned char *data,
63dfc768fbSStefan Wahren size_t count)
64dfc768fbSStefan Wahren {
65dfc768fbSStefan Wahren struct qcauart *qca = serdev_device_get_drvdata(serdev);
66dfc768fbSStefan Wahren struct net_device *netdev = qca->net_dev;
67dfc768fbSStefan Wahren struct net_device_stats *n_stats = &netdev->stats;
68dfc768fbSStefan Wahren size_t i;
69dfc768fbSStefan Wahren
70dfc768fbSStefan Wahren if (!qca->rx_skb) {
71dfc768fbSStefan Wahren qca->rx_skb = netdev_alloc_skb_ip_align(netdev,
72dfc768fbSStefan Wahren netdev->mtu +
73dfc768fbSStefan Wahren VLAN_ETH_HLEN);
74dfc768fbSStefan Wahren if (!qca->rx_skb) {
75dfc768fbSStefan Wahren n_stats->rx_errors++;
76dfc768fbSStefan Wahren n_stats->rx_dropped++;
77dfc768fbSStefan Wahren return 0;
78dfc768fbSStefan Wahren }
79dfc768fbSStefan Wahren }
80dfc768fbSStefan Wahren
81dfc768fbSStefan Wahren for (i = 0; i < count; i++) {
82dfc768fbSStefan Wahren s32 retcode;
83dfc768fbSStefan Wahren
84dfc768fbSStefan Wahren retcode = qcafrm_fsm_decode(&qca->frm_handle,
85dfc768fbSStefan Wahren qca->rx_skb->data,
86dfc768fbSStefan Wahren skb_tailroom(qca->rx_skb),
87dfc768fbSStefan Wahren data[i]);
88dfc768fbSStefan Wahren
89dfc768fbSStefan Wahren switch (retcode) {
90dfc768fbSStefan Wahren case QCAFRM_GATHER:
91dfc768fbSStefan Wahren case QCAFRM_NOHEAD:
92dfc768fbSStefan Wahren break;
93dfc768fbSStefan Wahren case QCAFRM_NOTAIL:
94dfc768fbSStefan Wahren netdev_dbg(netdev, "recv: no RX tail\n");
95dfc768fbSStefan Wahren n_stats->rx_errors++;
96dfc768fbSStefan Wahren n_stats->rx_dropped++;
97dfc768fbSStefan Wahren break;
98dfc768fbSStefan Wahren case QCAFRM_INVLEN:
99dfc768fbSStefan Wahren netdev_dbg(netdev, "recv: invalid RX length\n");
100dfc768fbSStefan Wahren n_stats->rx_errors++;
101dfc768fbSStefan Wahren n_stats->rx_dropped++;
102dfc768fbSStefan Wahren break;
103dfc768fbSStefan Wahren default:
104dfc768fbSStefan Wahren n_stats->rx_packets++;
105dfc768fbSStefan Wahren n_stats->rx_bytes += retcode;
106dfc768fbSStefan Wahren skb_put(qca->rx_skb, retcode);
107dfc768fbSStefan Wahren qca->rx_skb->protocol = eth_type_trans(
108dfc768fbSStefan Wahren qca->rx_skb, qca->rx_skb->dev);
109429205daSStefan Wahren skb_checksum_none_assert(qca->rx_skb);
11090f77c1cSSebastian Andrzej Siewior netif_rx(qca->rx_skb);
111dfc768fbSStefan Wahren qca->rx_skb = netdev_alloc_skb_ip_align(netdev,
112dfc768fbSStefan Wahren netdev->mtu +
113dfc768fbSStefan Wahren VLAN_ETH_HLEN);
114dfc768fbSStefan Wahren if (!qca->rx_skb) {
115dfc768fbSStefan Wahren netdev_dbg(netdev, "recv: out of RX resources\n");
116dfc768fbSStefan Wahren n_stats->rx_errors++;
117dfc768fbSStefan Wahren return i;
118dfc768fbSStefan Wahren }
119dfc768fbSStefan Wahren }
120dfc768fbSStefan Wahren }
121dfc768fbSStefan Wahren
122dfc768fbSStefan Wahren return i;
123dfc768fbSStefan Wahren }
124dfc768fbSStefan Wahren
125dfc768fbSStefan Wahren /* Write out any remaining transmit buffer. Scheduled when tty is writable */
qcauart_transmit(struct work_struct * work)126dfc768fbSStefan Wahren static void qcauart_transmit(struct work_struct *work)
127dfc768fbSStefan Wahren {
128dfc768fbSStefan Wahren struct qcauart *qca = container_of(work, struct qcauart, tx_work);
129dfc768fbSStefan Wahren struct net_device_stats *n_stats = &qca->net_dev->stats;
130dfc768fbSStefan Wahren int written;
131dfc768fbSStefan Wahren
132dfc768fbSStefan Wahren spin_lock_bh(&qca->lock);
133dfc768fbSStefan Wahren
134dfc768fbSStefan Wahren /* First make sure we're connected. */
135dfc768fbSStefan Wahren if (!netif_running(qca->net_dev)) {
136dfc768fbSStefan Wahren spin_unlock_bh(&qca->lock);
137dfc768fbSStefan Wahren return;
138dfc768fbSStefan Wahren }
139dfc768fbSStefan Wahren
140dfc768fbSStefan Wahren if (qca->tx_left <= 0) {
141dfc768fbSStefan Wahren /* Now serial buffer is almost free & we can start
142dfc768fbSStefan Wahren * transmission of another packet
143dfc768fbSStefan Wahren */
144dfc768fbSStefan Wahren n_stats->tx_packets++;
145dfc768fbSStefan Wahren spin_unlock_bh(&qca->lock);
146dfc768fbSStefan Wahren netif_wake_queue(qca->net_dev);
147dfc768fbSStefan Wahren return;
148dfc768fbSStefan Wahren }
149dfc768fbSStefan Wahren
150dfc768fbSStefan Wahren written = serdev_device_write_buf(qca->serdev, qca->tx_head,
151dfc768fbSStefan Wahren qca->tx_left);
152dfc768fbSStefan Wahren if (written > 0) {
153dfc768fbSStefan Wahren qca->tx_left -= written;
154dfc768fbSStefan Wahren qca->tx_head += written;
155dfc768fbSStefan Wahren }
156dfc768fbSStefan Wahren spin_unlock_bh(&qca->lock);
157dfc768fbSStefan Wahren }
158dfc768fbSStefan Wahren
159dfc768fbSStefan Wahren /* Called by the driver when there's room for more data.
160dfc768fbSStefan Wahren * Schedule the transmit.
161dfc768fbSStefan Wahren */
qca_tty_wakeup(struct serdev_device * serdev)162dfc768fbSStefan Wahren static void qca_tty_wakeup(struct serdev_device *serdev)
163dfc768fbSStefan Wahren {
164dfc768fbSStefan Wahren struct qcauart *qca = serdev_device_get_drvdata(serdev);
165dfc768fbSStefan Wahren
166dfc768fbSStefan Wahren schedule_work(&qca->tx_work);
167dfc768fbSStefan Wahren }
168dfc768fbSStefan Wahren
169715d0871SRikard Falkeborn static const struct serdev_device_ops qca_serdev_ops = {
170dfc768fbSStefan Wahren .receive_buf = qca_tty_receive,
171dfc768fbSStefan Wahren .write_wakeup = qca_tty_wakeup,
172dfc768fbSStefan Wahren };
173dfc768fbSStefan Wahren
qcauart_netdev_open(struct net_device * dev)174dfc768fbSStefan Wahren static int qcauart_netdev_open(struct net_device *dev)
175dfc768fbSStefan Wahren {
176dfc768fbSStefan Wahren struct qcauart *qca = netdev_priv(dev);
177dfc768fbSStefan Wahren
178dfc768fbSStefan Wahren netif_start_queue(qca->net_dev);
179dfc768fbSStefan Wahren
180dfc768fbSStefan Wahren return 0;
181dfc768fbSStefan Wahren }
182dfc768fbSStefan Wahren
qcauart_netdev_close(struct net_device * dev)183dfc768fbSStefan Wahren static int qcauart_netdev_close(struct net_device *dev)
184dfc768fbSStefan Wahren {
185dfc768fbSStefan Wahren struct qcauart *qca = netdev_priv(dev);
186dfc768fbSStefan Wahren
187dfc768fbSStefan Wahren netif_stop_queue(dev);
188dfc768fbSStefan Wahren flush_work(&qca->tx_work);
189dfc768fbSStefan Wahren
190dfc768fbSStefan Wahren spin_lock_bh(&qca->lock);
191dfc768fbSStefan Wahren qca->tx_left = 0;
192dfc768fbSStefan Wahren spin_unlock_bh(&qca->lock);
193dfc768fbSStefan Wahren
194dfc768fbSStefan Wahren return 0;
195dfc768fbSStefan Wahren }
196dfc768fbSStefan Wahren
197dfc768fbSStefan Wahren static netdev_tx_t
qcauart_netdev_xmit(struct sk_buff * skb,struct net_device * dev)198dfc768fbSStefan Wahren qcauart_netdev_xmit(struct sk_buff *skb, struct net_device *dev)
199dfc768fbSStefan Wahren {
200dfc768fbSStefan Wahren struct net_device_stats *n_stats = &dev->stats;
201dfc768fbSStefan Wahren struct qcauart *qca = netdev_priv(dev);
202dfc768fbSStefan Wahren u8 pad_len = 0;
203dfc768fbSStefan Wahren int written;
204dfc768fbSStefan Wahren u8 *pos;
205dfc768fbSStefan Wahren
206dfc768fbSStefan Wahren spin_lock(&qca->lock);
207dfc768fbSStefan Wahren
208dfc768fbSStefan Wahren WARN_ON(qca->tx_left);
209dfc768fbSStefan Wahren
210dfc768fbSStefan Wahren if (!netif_running(dev)) {
211dfc768fbSStefan Wahren spin_unlock(&qca->lock);
212dfc768fbSStefan Wahren netdev_warn(qca->net_dev, "xmit: iface is down\n");
213dfc768fbSStefan Wahren goto out;
214dfc768fbSStefan Wahren }
215dfc768fbSStefan Wahren
216dfc768fbSStefan Wahren pos = qca->tx_buffer;
217dfc768fbSStefan Wahren
218dfc768fbSStefan Wahren if (skb->len < QCAFRM_MIN_LEN)
219dfc768fbSStefan Wahren pad_len = QCAFRM_MIN_LEN - skb->len;
220dfc768fbSStefan Wahren
221dfc768fbSStefan Wahren pos += qcafrm_create_header(pos, skb->len + pad_len);
222dfc768fbSStefan Wahren
223dfc768fbSStefan Wahren memcpy(pos, skb->data, skb->len);
224dfc768fbSStefan Wahren pos += skb->len;
225dfc768fbSStefan Wahren
226dfc768fbSStefan Wahren if (pad_len) {
227dfc768fbSStefan Wahren memset(pos, 0, pad_len);
228dfc768fbSStefan Wahren pos += pad_len;
229dfc768fbSStefan Wahren }
230dfc768fbSStefan Wahren
231dfc768fbSStefan Wahren pos += qcafrm_create_footer(pos);
232dfc768fbSStefan Wahren
233dfc768fbSStefan Wahren netif_stop_queue(qca->net_dev);
234dfc768fbSStefan Wahren
235dfc768fbSStefan Wahren written = serdev_device_write_buf(qca->serdev, qca->tx_buffer,
236dfc768fbSStefan Wahren pos - qca->tx_buffer);
237dfc768fbSStefan Wahren if (written > 0) {
238dfc768fbSStefan Wahren qca->tx_left = (pos - qca->tx_buffer) - written;
239dfc768fbSStefan Wahren qca->tx_head = qca->tx_buffer + written;
240dfc768fbSStefan Wahren n_stats->tx_bytes += written;
241dfc768fbSStefan Wahren }
242dfc768fbSStefan Wahren spin_unlock(&qca->lock);
243dfc768fbSStefan Wahren
244dfc768fbSStefan Wahren netif_trans_update(dev);
245dfc768fbSStefan Wahren out:
246dfc768fbSStefan Wahren dev_kfree_skb_any(skb);
247dfc768fbSStefan Wahren return NETDEV_TX_OK;
248dfc768fbSStefan Wahren }
249dfc768fbSStefan Wahren
qcauart_netdev_tx_timeout(struct net_device * dev,unsigned int txqueue)2500290bd29SMichael S. Tsirkin static void qcauart_netdev_tx_timeout(struct net_device *dev, unsigned int txqueue)
251dfc768fbSStefan Wahren {
252dfc768fbSStefan Wahren struct qcauart *qca = netdev_priv(dev);
253dfc768fbSStefan Wahren
254dfc768fbSStefan Wahren netdev_info(qca->net_dev, "Transmit timeout at %ld, latency %ld\n",
255dfc768fbSStefan Wahren jiffies, dev_trans_start(dev));
256dfc768fbSStefan Wahren dev->stats.tx_errors++;
257dfc768fbSStefan Wahren dev->stats.tx_dropped++;
258dfc768fbSStefan Wahren }
259dfc768fbSStefan Wahren
qcauart_netdev_init(struct net_device * dev)260dfc768fbSStefan Wahren static int qcauart_netdev_init(struct net_device *dev)
261dfc768fbSStefan Wahren {
262dfc768fbSStefan Wahren struct qcauart *qca = netdev_priv(dev);
263dfc768fbSStefan Wahren size_t len;
264dfc768fbSStefan Wahren
265dfc768fbSStefan Wahren /* Finish setting up the device info. */
266dfc768fbSStefan Wahren dev->mtu = QCAFRM_MAX_MTU;
267dfc768fbSStefan Wahren dev->type = ARPHRD_ETHER;
268dfc768fbSStefan Wahren
269dfc768fbSStefan Wahren len = QCAFRM_HEADER_LEN + QCAFRM_MAX_LEN + QCAFRM_FOOTER_LEN;
270dfc768fbSStefan Wahren qca->tx_buffer = devm_kmalloc(&qca->serdev->dev, len, GFP_KERNEL);
271dfc768fbSStefan Wahren if (!qca->tx_buffer)
272dfc768fbSStefan Wahren return -ENOMEM;
273dfc768fbSStefan Wahren
274dfc768fbSStefan Wahren qca->rx_skb = netdev_alloc_skb_ip_align(qca->net_dev,
275dfc768fbSStefan Wahren qca->net_dev->mtu +
276dfc768fbSStefan Wahren VLAN_ETH_HLEN);
277dfc768fbSStefan Wahren if (!qca->rx_skb)
278dfc768fbSStefan Wahren return -ENOBUFS;
279dfc768fbSStefan Wahren
280dfc768fbSStefan Wahren return 0;
281dfc768fbSStefan Wahren }
282dfc768fbSStefan Wahren
qcauart_netdev_uninit(struct net_device * dev)283dfc768fbSStefan Wahren static void qcauart_netdev_uninit(struct net_device *dev)
284dfc768fbSStefan Wahren {
285dfc768fbSStefan Wahren struct qcauart *qca = netdev_priv(dev);
286dfc768fbSStefan Wahren
287dfc768fbSStefan Wahren dev_kfree_skb(qca->rx_skb);
288dfc768fbSStefan Wahren }
289dfc768fbSStefan Wahren
290dfc768fbSStefan Wahren static const struct net_device_ops qcauart_netdev_ops = {
291dfc768fbSStefan Wahren .ndo_init = qcauart_netdev_init,
292dfc768fbSStefan Wahren .ndo_uninit = qcauart_netdev_uninit,
293dfc768fbSStefan Wahren .ndo_open = qcauart_netdev_open,
294dfc768fbSStefan Wahren .ndo_stop = qcauart_netdev_close,
295dfc768fbSStefan Wahren .ndo_start_xmit = qcauart_netdev_xmit,
296dfc768fbSStefan Wahren .ndo_set_mac_address = eth_mac_addr,
297dfc768fbSStefan Wahren .ndo_tx_timeout = qcauart_netdev_tx_timeout,
298dfc768fbSStefan Wahren .ndo_validate_addr = eth_validate_addr,
299dfc768fbSStefan Wahren };
300dfc768fbSStefan Wahren
qcauart_netdev_setup(struct net_device * dev)301dfc768fbSStefan Wahren static void qcauart_netdev_setup(struct net_device *dev)
302dfc768fbSStefan Wahren {
303dfc768fbSStefan Wahren dev->netdev_ops = &qcauart_netdev_ops;
304dfc768fbSStefan Wahren dev->watchdog_timeo = QCAUART_TX_TIMEOUT;
305dfc768fbSStefan Wahren dev->priv_flags &= ~IFF_TX_SKB_SHARING;
306dfc768fbSStefan Wahren dev->tx_queue_len = 100;
307dfc768fbSStefan Wahren
308dfc768fbSStefan Wahren /* MTU range: 46 - 1500 */
309dfc768fbSStefan Wahren dev->min_mtu = QCAFRM_MIN_MTU;
310dfc768fbSStefan Wahren dev->max_mtu = QCAFRM_MAX_MTU;
311dfc768fbSStefan Wahren }
312dfc768fbSStefan Wahren
313dfc768fbSStefan Wahren static const struct of_device_id qca_uart_of_match[] = {
314dfc768fbSStefan Wahren {
315dfc768fbSStefan Wahren .compatible = "qca,qca7000",
316dfc768fbSStefan Wahren },
317dfc768fbSStefan Wahren {}
318dfc768fbSStefan Wahren };
319dfc768fbSStefan Wahren MODULE_DEVICE_TABLE(of, qca_uart_of_match);
320dfc768fbSStefan Wahren
qca_uart_probe(struct serdev_device * serdev)321dfc768fbSStefan Wahren static int qca_uart_probe(struct serdev_device *serdev)
322dfc768fbSStefan Wahren {
323dfc768fbSStefan Wahren struct net_device *qcauart_dev = alloc_etherdev(sizeof(struct qcauart));
324dfc768fbSStefan Wahren struct qcauart *qca;
325dfc768fbSStefan Wahren u32 speed = 115200;
326dfc768fbSStefan Wahren int ret;
327dfc768fbSStefan Wahren
328dfc768fbSStefan Wahren if (!qcauart_dev)
329dfc768fbSStefan Wahren return -ENOMEM;
330dfc768fbSStefan Wahren
331dfc768fbSStefan Wahren qcauart_netdev_setup(qcauart_dev);
332dfc768fbSStefan Wahren SET_NETDEV_DEV(qcauart_dev, &serdev->dev);
333dfc768fbSStefan Wahren
334dfc768fbSStefan Wahren qca = netdev_priv(qcauart_dev);
335dfc768fbSStefan Wahren if (!qca) {
336dfc768fbSStefan Wahren pr_err("qca_uart: Fail to retrieve private structure\n");
337dfc768fbSStefan Wahren ret = -ENOMEM;
338dfc768fbSStefan Wahren goto free;
339dfc768fbSStefan Wahren }
340dfc768fbSStefan Wahren qca->net_dev = qcauart_dev;
341dfc768fbSStefan Wahren qca->serdev = serdev;
342dfc768fbSStefan Wahren qcafrm_fsm_init_uart(&qca->frm_handle);
343dfc768fbSStefan Wahren
344dfc768fbSStefan Wahren spin_lock_init(&qca->lock);
345dfc768fbSStefan Wahren INIT_WORK(&qca->tx_work, qcauart_transmit);
346dfc768fbSStefan Wahren
347dfc768fbSStefan Wahren of_property_read_u32(serdev->dev.of_node, "current-speed", &speed);
348dfc768fbSStefan Wahren
3499ca01b25SJakub Kicinski ret = of_get_ethdev_address(serdev->dev.of_node, qca->net_dev);
35083216e39SMichael Walle if (ret) {
351dfc768fbSStefan Wahren eth_hw_addr_random(qca->net_dev);
352dfc768fbSStefan Wahren dev_info(&serdev->dev, "Using random MAC address: %pM\n",
353dfc768fbSStefan Wahren qca->net_dev->dev_addr);
354dfc768fbSStefan Wahren }
355dfc768fbSStefan Wahren
356dfc768fbSStefan Wahren netif_carrier_on(qca->net_dev);
357dfc768fbSStefan Wahren serdev_device_set_drvdata(serdev, qca);
358dfc768fbSStefan Wahren serdev_device_set_client_ops(serdev, &qca_serdev_ops);
359dfc768fbSStefan Wahren
360dfc768fbSStefan Wahren ret = serdev_device_open(serdev);
361dfc768fbSStefan Wahren if (ret) {
362dfc768fbSStefan Wahren dev_err(&serdev->dev, "Unable to open device %s\n",
363dfc768fbSStefan Wahren qcauart_dev->name);
364dfc768fbSStefan Wahren goto free;
365dfc768fbSStefan Wahren }
366dfc768fbSStefan Wahren
367dfc768fbSStefan Wahren speed = serdev_device_set_baudrate(serdev, speed);
368dfc768fbSStefan Wahren dev_info(&serdev->dev, "Using baudrate: %u\n", speed);
369dfc768fbSStefan Wahren
370dfc768fbSStefan Wahren serdev_device_set_flow_control(serdev, false);
371dfc768fbSStefan Wahren
372dfc768fbSStefan Wahren ret = register_netdev(qcauart_dev);
373dfc768fbSStefan Wahren if (ret) {
374dfc768fbSStefan Wahren dev_err(&serdev->dev, "Unable to register net device %s\n",
375dfc768fbSStefan Wahren qcauart_dev->name);
376dfc768fbSStefan Wahren serdev_device_close(serdev);
377dfc768fbSStefan Wahren cancel_work_sync(&qca->tx_work);
378dfc768fbSStefan Wahren goto free;
379dfc768fbSStefan Wahren }
380dfc768fbSStefan Wahren
381dfc768fbSStefan Wahren return 0;
382dfc768fbSStefan Wahren
383dfc768fbSStefan Wahren free:
384dfc768fbSStefan Wahren free_netdev(qcauart_dev);
385dfc768fbSStefan Wahren return ret;
386dfc768fbSStefan Wahren }
387dfc768fbSStefan Wahren
qca_uart_remove(struct serdev_device * serdev)388dfc768fbSStefan Wahren static void qca_uart_remove(struct serdev_device *serdev)
389dfc768fbSStefan Wahren {
390dfc768fbSStefan Wahren struct qcauart *qca = serdev_device_get_drvdata(serdev);
391dfc768fbSStefan Wahren
392dfc768fbSStefan Wahren unregister_netdev(qca->net_dev);
393dfc768fbSStefan Wahren
394dfc768fbSStefan Wahren /* Flush any pending characters in the driver. */
395dfc768fbSStefan Wahren serdev_device_close(serdev);
396dfc768fbSStefan Wahren cancel_work_sync(&qca->tx_work);
397dfc768fbSStefan Wahren
398dfc768fbSStefan Wahren free_netdev(qca->net_dev);
399dfc768fbSStefan Wahren }
400dfc768fbSStefan Wahren
401dfc768fbSStefan Wahren static struct serdev_device_driver qca_uart_driver = {
402dfc768fbSStefan Wahren .probe = qca_uart_probe,
403dfc768fbSStefan Wahren .remove = qca_uart_remove,
404dfc768fbSStefan Wahren .driver = {
405dfc768fbSStefan Wahren .name = QCAUART_DRV_NAME,
406*537a6b99SRuan Jinjie .of_match_table = qca_uart_of_match,
407dfc768fbSStefan Wahren },
408dfc768fbSStefan Wahren };
409dfc768fbSStefan Wahren
410dfc768fbSStefan Wahren module_serdev_device_driver(qca_uart_driver);
411dfc768fbSStefan Wahren
412dfc768fbSStefan Wahren MODULE_DESCRIPTION("Qualcomm Atheros QCA7000 UART Driver");
413dfc768fbSStefan Wahren MODULE_AUTHOR("Qualcomm Atheros Communications");
414dfc768fbSStefan Wahren MODULE_AUTHOR("Stefan Wahren <stefan.wahren@i2se.com>");
415dfc768fbSStefan Wahren MODULE_LICENSE("Dual BSD/GPL");
416dfc768fbSStefan Wahren MODULE_VERSION(QCAUART_DRV_VERSION);
417