123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808 |
- /*
- * Copyright (c) 2011-2013, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- */
- #include <linux/kernel.h>
- #include <linux/interrupt.h>
- #include <linux/device.h>
- #include <linux/delay.h>
- #include <linux/slab.h>
- #include <linux/termios.h>
- #include <mach/msm_smd.h>
- #include <linux/debugfs.h>
- #include <linux/bitops.h>
- #include <linux/termios.h>
- #include "u_rmnet.h"
- #define MAX_CTRL_PER_CLIENT 3
- #define MAX_CTRL_PORT (MAX_CTRL_PER_CLIENT * NR_CTRL_CLIENTS)
- static char *ctrl_names[NR_CTRL_CLIENTS][MAX_CTRL_PER_CLIENT] = {
- {"DATA40_CNTL", "DATA39_CNTL", "DATA38_CNTL"},
- {"DATA39_CNTL"},
- };
- static struct workqueue_struct *grmnet_ctrl_wq;
- u8 online_clients;
- #define SMD_CH_MAX_LEN 20
- #define CH_OPENED 0
- #define CH_READY 1
- #define CH_PREPARE_READY 2
- struct smd_ch_info {
- struct smd_channel *ch;
- char *name;
- unsigned long flags;
- wait_queue_head_t wait;
- wait_queue_head_t smd_wait_q;
- unsigned dtr;
- struct list_head tx_q;
- unsigned long tx_len;
- struct work_struct read_w;
- struct work_struct write_w;
- struct rmnet_ctrl_port *port;
- int cbits_tomodem;
- /* stats */
- unsigned long to_modem;
- unsigned long to_host;
- };
- struct rmnet_ctrl_port {
- struct smd_ch_info ctrl_ch;
- unsigned int port_num;
- struct grmnet *port_usb;
- spinlock_t port_lock;
- struct delayed_work connect_w;
- struct delayed_work disconnect_w;
- };
- static struct rmnet_ctrl_ports {
- struct rmnet_ctrl_port *port;
- struct platform_driver pdrv;
- } ctrl_smd_ports[MAX_CTRL_PORT];
- /*---------------misc functions---------------- */
- static struct rmnet_ctrl_pkt *alloc_rmnet_ctrl_pkt(unsigned len, gfp_t flags)
- {
- struct rmnet_ctrl_pkt *pkt;
- pkt = kzalloc(sizeof(struct rmnet_ctrl_pkt), flags);
- if (!pkt)
- return ERR_PTR(-ENOMEM);
- pkt->buf = kmalloc(len, flags);
- if (!pkt->buf) {
- kfree(pkt);
- return ERR_PTR(-ENOMEM);
- }
- pkt->len = len;
- return pkt;
- }
- static void free_rmnet_ctrl_pkt(struct rmnet_ctrl_pkt *pkt)
- {
- kfree(pkt->buf);
- kfree(pkt);
- }
- /*--------------------------------------------- */
- /*---------------control/smd channel functions---------------- */
- static void grmnet_ctrl_smd_read_w(struct work_struct *w)
- {
- struct smd_ch_info *c = container_of(w, struct smd_ch_info, read_w);
- struct rmnet_ctrl_port *port = c->port;
- int sz, total_received, read_avail;
- int len;
- void *buf;
- unsigned long flags;
- spin_lock_irqsave(&port->port_lock, flags);
- while (c->ch) {
- sz = smd_cur_packet_size(c->ch);
- if (sz <= 0)
- break;
- spin_unlock_irqrestore(&port->port_lock, flags);
- buf = kmalloc(sz, GFP_KERNEL);
- if (!buf)
- return;
- total_received = 0;
- while (total_received < sz) {
- wait_event(c->smd_wait_q,
- ((read_avail = smd_read_avail(c->ch)) ||
- (c->ch == 0)));
- if (read_avail < 0 || c->ch == 0) {
- pr_err("%s:smd read_avail failure:%d or channel closed ch=%pK",
- __func__, read_avail, c->ch);
- kfree(buf);
- return;
- }
- if (read_avail + total_received > sz) {
- pr_err("%s: SMD sending incorrect pkt\n",
- __func__);
- kfree(buf);
- return;
- }
- len = smd_read(c->ch, buf + total_received, read_avail);
- if (len <= 0) {
- pr_err("%s: smd read failure %d\n",
- __func__, len);
- kfree(buf);
- return;
- }
- total_received += len;
- }
- /* send it to USB here */
- spin_lock_irqsave(&port->port_lock, flags);
- if (port->port_usb && port->port_usb->send_cpkt_response) {
- port->port_usb->send_cpkt_response(port->port_usb,
- buf, sz);
- c->to_host++;
- }
- kfree(buf);
- }
- spin_unlock_irqrestore(&port->port_lock, flags);
- }
- static void grmnet_ctrl_smd_write_w(struct work_struct *w)
- {
- struct smd_ch_info *c = container_of(w, struct smd_ch_info, write_w);
- struct rmnet_ctrl_port *port = c->port;
- unsigned long flags;
- struct rmnet_ctrl_pkt *cpkt;
- int ret;
- spin_lock_irqsave(&port->port_lock, flags);
- while (c->ch) {
- if (list_empty(&c->tx_q))
- break;
- cpkt = list_first_entry(&c->tx_q, struct rmnet_ctrl_pkt, list);
- if (smd_write_avail(c->ch) < cpkt->len)
- break;
- list_del(&cpkt->list);
- spin_unlock_irqrestore(&port->port_lock, flags);
- ret = smd_write(c->ch, cpkt->buf, cpkt->len);
- spin_lock_irqsave(&port->port_lock, flags);
- if (ret != cpkt->len) {
- pr_err("%s: smd_write failed err:%d\n", __func__, ret);
- free_rmnet_ctrl_pkt(cpkt);
- break;
- }
- free_rmnet_ctrl_pkt(cpkt);
- c->to_modem++;
- }
- spin_unlock_irqrestore(&port->port_lock, flags);
- }
- static int is_legal_port_num(u8 portno)
- {
- if (portno >= MAX_CTRL_PORT)
- return false;
- if (ctrl_smd_ports[portno].port == NULL)
- return false;
- return true;
- }
- static int
- grmnet_ctrl_smd_send_cpkt_tomodem(u8 portno,
- void *buf, size_t len)
- {
- unsigned long flags;
- struct rmnet_ctrl_port *port;
- struct smd_ch_info *c;
- struct rmnet_ctrl_pkt *cpkt;
- if (!is_legal_port_num(portno)) {
- pr_err("%s: Invalid portno#%d\n", __func__, portno);
- return -ENODEV;
- }
- port = ctrl_smd_ports[portno].port;
- cpkt = alloc_rmnet_ctrl_pkt(len, GFP_ATOMIC);
- if (IS_ERR(cpkt)) {
- pr_err("%s: Unable to allocate ctrl pkt\n", __func__);
- return -ENOMEM;
- }
- memcpy(cpkt->buf, buf, len);
- cpkt->len = len;
- spin_lock_irqsave(&port->port_lock, flags);
- c = &port->ctrl_ch;
- /* drop cpkt if ch is not open */
- if (!test_bit(CH_OPENED, &c->flags)) {
- free_rmnet_ctrl_pkt(cpkt);
- spin_unlock_irqrestore(&port->port_lock, flags);
- return 0;
- }
- list_add_tail(&cpkt->list, &c->tx_q);
- queue_work(grmnet_ctrl_wq, &c->write_w);
- spin_unlock_irqrestore(&port->port_lock, flags);
- return 0;
- }
- #define RMNET_CTRL_DTR 0x01
- static void
- gsmd_ctrl_send_cbits_tomodem(void *gptr, u8 portno, int cbits)
- {
- struct rmnet_ctrl_port *port;
- struct smd_ch_info *c;
- int set_bits = 0;
- int clear_bits = 0;
- int temp = 0;
- if (!is_legal_port_num(portno)) {
- pr_err("%s: Invalid portno#%d\n", __func__, portno);
- return;
- }
- if (!gptr) {
- pr_err("%s: grmnet is null\n", __func__);
- return;
- }
- port = ctrl_smd_ports[portno].port;
- cbits = cbits & RMNET_CTRL_DTR;
- c = &port->ctrl_ch;
- /* host driver will only send DTR, but to have generic
- * set and clear bit implementation using two separate
- * checks
- */
- if (cbits & RMNET_CTRL_DTR)
- set_bits |= TIOCM_DTR;
- else
- clear_bits |= TIOCM_DTR;
- temp |= set_bits;
- temp &= ~clear_bits;
- if (temp == c->cbits_tomodem)
- return;
- c->cbits_tomodem = temp;
- if (!test_bit(CH_OPENED, &c->flags))
- return;
- pr_debug("%s: ctrl_tomodem:%d ctrl_bits:%d setbits:%d clearbits:%d\n",
- __func__, temp, cbits, set_bits, clear_bits);
- smd_tiocmset(c->ch, set_bits, clear_bits);
- }
- static char *get_smd_event(unsigned event)
- {
- switch (event) {
- case SMD_EVENT_DATA:
- return "DATA";
- case SMD_EVENT_OPEN:
- return "OPEN";
- case SMD_EVENT_CLOSE:
- return "CLOSE";
- }
- return "UNDEFINED";
- }
- static void grmnet_ctrl_smd_notify(void *p, unsigned event)
- {
- struct rmnet_ctrl_port *port = p;
- struct smd_ch_info *c = &port->ctrl_ch;
- struct rmnet_ctrl_pkt *cpkt;
- unsigned long flags;
- pr_debug("%s: EVENT_(%s)\n", __func__, get_smd_event(event));
- switch (event) {
- case SMD_EVENT_DATA:
- if (smd_read_avail(c->ch) && !waitqueue_active(&c->smd_wait_q))
- queue_work(grmnet_ctrl_wq, &c->read_w);
- if (smd_write_avail(c->ch))
- queue_work(grmnet_ctrl_wq, &c->write_w);
- break;
- case SMD_EVENT_OPEN:
- set_bit(CH_OPENED, &c->flags);
- if (port && port->port_usb && port->port_usb->connect)
- port->port_usb->connect(port->port_usb);
- break;
- case SMD_EVENT_CLOSE:
- clear_bit(CH_OPENED, &c->flags);
- if (port && port->port_usb && port->port_usb->disconnect)
- port->port_usb->disconnect(port->port_usb);
- spin_lock_irqsave(&port->port_lock, flags);
- while (!list_empty(&c->tx_q)) {
- cpkt = list_first_entry(&c->tx_q,
- struct rmnet_ctrl_pkt, list);
- list_del(&cpkt->list);
- free_rmnet_ctrl_pkt(cpkt);
- }
- spin_unlock_irqrestore(&port->port_lock, flags);
- break;
- }
- wake_up(&c->smd_wait_q);
- }
- /*------------------------------------------------------------ */
- static void grmnet_ctrl_smd_connect_w(struct work_struct *w)
- {
- struct rmnet_ctrl_port *port =
- container_of(w, struct rmnet_ctrl_port, connect_w.work);
- struct rmnet_ctrl_ports *port_entry = &ctrl_smd_ports[port->port_num];
- struct smd_ch_info *c = &port->ctrl_ch;
- unsigned long flags;
- int set_bits = 0;
- int clear_bits = 0;
- int ret;
- pr_debug("%s:\n", __func__);
- if (!test_bit(CH_READY, &c->flags)) {
- if (!test_bit(CH_PREPARE_READY, &c->flags)) {
- set_bit(CH_PREPARE_READY, &c->flags);
- platform_driver_register(&(port_entry->pdrv));
- }
- return;
- }
- ret = smd_open(c->name, &c->ch, port, grmnet_ctrl_smd_notify);
- if (ret) {
- if (ret == -EAGAIN) {
- /* port not ready - retry */
- pr_debug("%s: SMD port not ready - rescheduling:%s err:%d\n",
- __func__, c->name, ret);
- queue_delayed_work(grmnet_ctrl_wq, &port->connect_w,
- msecs_to_jiffies(250));
- } else {
- pr_err("%s: unable to open smd port:%s err:%d\n",
- __func__, c->name, ret);
- }
- return;
- }
- set_bits = c->cbits_tomodem;
- clear_bits = ~(c->cbits_tomodem | TIOCM_RTS);
- spin_lock_irqsave(&port->port_lock, flags);
- if (port->port_usb)
- smd_tiocmset(c->ch, set_bits, clear_bits);
- spin_unlock_irqrestore(&port->port_lock, flags);
- }
- int gsmd_ctrl_connect(struct grmnet *gr, int port_num)
- {
- struct rmnet_ctrl_port *port;
- struct smd_ch_info *c;
- unsigned long flags;
- pr_debug("%s: grmnet:%pK port#%d\n", __func__, gr, port_num);
- if (!is_legal_port_num(port_num)) {
- pr_err("%s: Invalid port_num#%d\n", __func__, port_num);
- return -ENODEV;
- }
- if (!gr) {
- pr_err("%s: grmnet port is null\n", __func__);
- return -ENODEV;
- }
- port = ctrl_smd_ports[port_num].port;
- c = &port->ctrl_ch;
- spin_lock_irqsave(&port->port_lock, flags);
- port->port_usb = gr;
- gr->send_encap_cmd = grmnet_ctrl_smd_send_cpkt_tomodem;
- gr->notify_modem = gsmd_ctrl_send_cbits_tomodem;
- spin_unlock_irqrestore(&port->port_lock, flags);
- queue_delayed_work(grmnet_ctrl_wq, &port->connect_w, 0);
- return 0;
- }
- static void grmnet_ctrl_smd_disconnect_w(struct work_struct *w)
- {
- struct rmnet_ctrl_port *port =
- container_of(w, struct rmnet_ctrl_port,
- disconnect_w.work);
- struct smd_ch_info *c;
- struct platform_driver *pdrv;
- c = &port->ctrl_ch;
- if (c->ch) {
- smd_close(c->ch);
- c->ch = NULL;
- }
- if (test_bit(CH_READY, &c->flags) ||
- test_bit(CH_PREPARE_READY, &c->flags)) {
- clear_bit(CH_PREPARE_READY, &c->flags);
- pdrv = &ctrl_smd_ports[port->port_num].pdrv;
- platform_driver_unregister(pdrv);
- }
- }
- void gsmd_ctrl_disconnect(struct grmnet *gr, u8 port_num)
- {
- struct rmnet_ctrl_port *port;
- unsigned long flags;
- struct smd_ch_info *c;
- struct rmnet_ctrl_pkt *cpkt;
- int clear_bits;
- pr_debug("%s: grmnet:%pK port#%d\n", __func__, gr, port_num);
- if (!is_legal_port_num(port_num)) {
- pr_err("%s: Invalid port_num#%d\n", __func__, port_num);
- return;
- }
- if (!gr) {
- pr_err("%s: grmnet port is null\n", __func__);
- return;
- }
- port = ctrl_smd_ports[port_num].port;
- c = &port->ctrl_ch;
- spin_lock_irqsave(&port->port_lock, flags);
- port->port_usb = 0;
- gr->send_encap_cmd = 0;
- gr->notify_modem = 0;
- c->cbits_tomodem = 0;
- while (!list_empty(&c->tx_q)) {
- cpkt = list_first_entry(&c->tx_q, struct rmnet_ctrl_pkt, list);
- list_del(&cpkt->list);
- free_rmnet_ctrl_pkt(cpkt);
- }
- spin_unlock_irqrestore(&port->port_lock, flags);
- if (test_and_clear_bit(CH_OPENED, &c->flags)) {
- clear_bits = ~(c->cbits_tomodem | TIOCM_RTS);
- /* send dtr zero */
- smd_tiocmset(c->ch, c->cbits_tomodem, clear_bits);
- }
- queue_delayed_work(grmnet_ctrl_wq, &port->disconnect_w, 0);
- }
- #define SMD_CH_MAX_LEN 20
- static int grmnet_ctrl_smd_ch_probe(struct platform_device *pdev)
- {
- struct rmnet_ctrl_port *port;
- struct smd_ch_info *c;
- int i;
- unsigned long flags;
- pr_debug("%s: name:%s\n", __func__, pdev->name);
- for (i = 0; i < MAX_CTRL_PORT; i++) {
- if (!ctrl_smd_ports[i].port)
- continue;
- port = ctrl_smd_ports[i].port;
- c = &port->ctrl_ch;
- if (!strncmp(c->name, pdev->name, SMD_CH_MAX_LEN)) {
- clear_bit(CH_PREPARE_READY, &c->flags);
- set_bit(CH_READY, &c->flags);
- /* if usb is online, try opening smd_ch */
- spin_lock_irqsave(&port->port_lock, flags);
- if (port->port_usb)
- queue_delayed_work(grmnet_ctrl_wq,
- &port->connect_w, 0);
- spin_unlock_irqrestore(&port->port_lock, flags);
- break;
- }
- }
- return 0;
- }
- static int grmnet_ctrl_smd_ch_remove(struct platform_device *pdev)
- {
- struct rmnet_ctrl_port *port;
- struct smd_ch_info *c;
- int i;
- pr_debug("%s: name:%s\n", __func__, pdev->name);
- for (i = 0; i < MAX_CTRL_PORT; i++) {
- if (!ctrl_smd_ports[i].port)
- continue;
- port = ctrl_smd_ports[i].port;
- c = &port->ctrl_ch;
- if (!strncmp(c->name, pdev->name, SMD_CH_MAX_LEN)) {
- clear_bit(CH_READY, &c->flags);
- clear_bit(CH_OPENED, &c->flags);
- if (c->ch) {
- smd_close(c->ch);
- c->ch = NULL;
- }
- break;
- }
- }
- return 0;
- }
- static void grmnet_ctrl_smd_port_free(int portno)
- {
- struct rmnet_ctrl_port *port = ctrl_smd_ports[portno].port;
- struct platform_driver *pdrv = &ctrl_smd_ports[portno].pdrv;
- if (port) {
- kfree(port);
- platform_driver_unregister(pdrv);
- }
- }
- static int grmnet_ctrl_smd_port_alloc(int portno)
- {
- struct rmnet_ctrl_port *port;
- struct smd_ch_info *c;
- struct platform_driver *pdrv;
- port = kzalloc(sizeof(struct rmnet_ctrl_port), GFP_KERNEL);
- if (!port)
- return -ENOMEM;
- port->port_num = portno;
- spin_lock_init(&port->port_lock);
- INIT_DELAYED_WORK(&port->connect_w, grmnet_ctrl_smd_connect_w);
- INIT_DELAYED_WORK(&port->disconnect_w, grmnet_ctrl_smd_disconnect_w);
- c = &port->ctrl_ch;
- c->name = ctrl_names[portno / MAX_CTRL_PER_CLIENT]
- [portno % MAX_CTRL_PER_CLIENT];
- c->port = port;
- init_waitqueue_head(&c->wait);
- init_waitqueue_head(&c->smd_wait_q);
- INIT_LIST_HEAD(&c->tx_q);
- INIT_WORK(&c->read_w, grmnet_ctrl_smd_read_w);
- INIT_WORK(&c->write_w, grmnet_ctrl_smd_write_w);
- ctrl_smd_ports[portno].port = port;
- pdrv = &ctrl_smd_ports[portno].pdrv;
- pdrv->probe = grmnet_ctrl_smd_ch_probe;
- pdrv->remove = grmnet_ctrl_smd_ch_remove;
- pdrv->driver.name = c->name;
- pdrv->driver.owner = THIS_MODULE;
- pr_debug("%s: port:%pK portno:%d\n", __func__, port, portno);
- return 0;
- }
- int gsmd_ctrl_setup(enum ctrl_client client_num, unsigned int count,
- u8 *first_port_idx)
- {
- int i, start_port, allocated_ports;
- int ret;
- pr_debug("%s: requested ports:%d\n", __func__, count);
- if (client_num >= NR_CTRL_CLIENTS) {
- pr_err("%s: Invalid client:%d\n", __func__, client_num);
- return -EINVAL;
- }
- if (!count || count > MAX_CTRL_PER_CLIENT) {
- pr_err("%s: Invalid num of ports count:%d\n",
- __func__, count);
- return -EINVAL;
- }
- if (!online_clients) {
- grmnet_ctrl_wq = alloc_workqueue("gsmd_ctrl",
- WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
- if (!grmnet_ctrl_wq) {
- pr_err("%s: Unable to create workqueue grmnet_ctrl\n",
- __func__);
- return -ENOMEM;
- }
- }
- online_clients++;
- start_port = MAX_CTRL_PER_CLIENT * client_num;
- allocated_ports = 0;
- for (i = start_port; i < count + start_port; i++) {
- allocated_ports++;
- ret = grmnet_ctrl_smd_port_alloc(i);
- if (ret) {
- pr_err("%s: Unable to alloc port:%d\n", __func__, i);
- allocated_ports--;
- goto free_ctrl_smd_ports;
- }
- }
- if (first_port_idx)
- *first_port_idx = start_port;
- return 0;
- free_ctrl_smd_ports:
- for (i = 0; i < allocated_ports; i++)
- grmnet_ctrl_smd_port_free(start_port + i);
- online_clients--;
- if (!online_clients)
- destroy_workqueue(grmnet_ctrl_wq);
- return ret;
- }
- #if defined(CONFIG_DEBUG_FS)
- #define DEBUG_BUF_SIZE 1024
- static ssize_t gsmd_ctrl_read_stats(struct file *file, char __user *ubuf,
- size_t count, loff_t *ppos)
- {
- struct rmnet_ctrl_port *port;
- struct smd_ch_info *c;
- char *buf;
- unsigned long flags;
- int ret;
- int i;
- int temp = 0;
- buf = kzalloc(sizeof(char) * DEBUG_BUF_SIZE, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
- for (i = 0; i < MAX_CTRL_PORT; i++) {
- if (!ctrl_smd_ports[i].port)
- continue;
- port = ctrl_smd_ports[i].port;
- spin_lock_irqsave(&port->port_lock, flags);
- c = &port->ctrl_ch;
- temp += scnprintf(buf + temp, DEBUG_BUF_SIZE - temp,
- "#PORT:%d port:%pK ctrl_ch:%pK#\n"
- "to_usbhost: %lu\n"
- "to_modem: %lu\n"
- "DTR: %s\n"
- "ch_open: %d\n"
- "ch_ready: %d\n"
- "read_avail: %d\n"
- "write_avail:%d\n",
- i, port, &port->ctrl_ch,
- c->to_host, c->to_modem,
- c->cbits_tomodem ? "HIGH" : "LOW",
- test_bit(CH_OPENED, &c->flags),
- test_bit(CH_READY, &c->flags),
- c->ch ? smd_read_avail(c->ch) : 0,
- c->ch ? smd_write_avail(c->ch) : 0);
- spin_unlock_irqrestore(&port->port_lock, flags);
- }
- ret = simple_read_from_buffer(ubuf, count, ppos, buf, temp);
- kfree(buf);
- return ret;
- }
- static ssize_t gsmd_ctrl_reset_stats(struct file *file, const char __user *buf,
- size_t count, loff_t *ppos)
- {
- struct rmnet_ctrl_port *port;
- struct smd_ch_info *c;
- int i;
- unsigned long flags;
- for (i = 0; i < MAX_CTRL_PORT; i++) {
- if (!ctrl_smd_ports[i].port)
- continue;
- port = ctrl_smd_ports[i].port;
- spin_lock_irqsave(&port->port_lock, flags);
- c = &port->ctrl_ch;
- c->to_host = 0;
- c->to_modem = 0;
- spin_unlock_irqrestore(&port->port_lock, flags);
- }
- return count;
- }
- const struct file_operations gsmd_ctrl_stats_ops = {
- .read = gsmd_ctrl_read_stats,
- .write = gsmd_ctrl_reset_stats,
- };
- struct dentry *smd_ctrl_dent;
- struct dentry *smd_ctrl_dfile;
- static void gsmd_ctrl_debugfs_init(void)
- {
- smd_ctrl_dent = debugfs_create_dir("usb_rmnet_ctrl_smd", 0);
- if (IS_ERR(smd_ctrl_dent))
- return;
- smd_ctrl_dfile = debugfs_create_file("status", 0444, smd_ctrl_dent, 0,
- &gsmd_ctrl_stats_ops);
- if (!smd_ctrl_dfile || IS_ERR(smd_ctrl_dfile))
- debugfs_remove(smd_ctrl_dent);
- }
- static void gsmd_ctrl_debugfs_exit(void)
- {
- debugfs_remove(smd_ctrl_dfile);
- debugfs_remove(smd_ctrl_dent);
- }
- #else
- static void gsmd_ctrl_debugfs_init(void) { }
- static void gsmd_ctrl_debugfs_exit(void) { }
- #endif
- static int __init gsmd_ctrl_init(void)
- {
- gsmd_ctrl_debugfs_init();
- online_clients = 0;
- return 0;
- }
- module_init(gsmd_ctrl_init);
- static void __exit gsmd_ctrl_exit(void)
- {
- gsmd_ctrl_debugfs_exit();
- }
- module_exit(gsmd_ctrl_exit);
- MODULE_DESCRIPTION("smd control driver");
- MODULE_LICENSE("GPL v2");
|