Staging: HTC Dream: add smd code
Infrastructure to support the Qualcomm "shared memory driver" interface, used to communicate with the baseband processor on MSM7k SoCs. The smd core provides low level facilities to interact with the shared memory comms region, and a "virtual serial channel" interface that higher level transports (AT command channel, rmnet virtual ethernet, qmi network management protocol, and oncrpc, for example) are routed over. Signed-off-by: Pavel Machek <pavel@ucw.cz> Cc: Brian Swetland <swetland@google.com> Cc: Iliyan Malchev <ibm@android.com> Cc: San Mehat <san@android.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
dda7940539
commit
0d8dc6b05b
File diff suppressed because it is too large
Load Diff
|
@ -0,0 +1,171 @@
|
|||
/* arch/arm/mach-msm/smd_private.h
|
||||
*
|
||||
* Copyright (C) 2007 Google, Inc.
|
||||
* Copyright (c) 2007 QUALCOMM Incorporated
|
||||
*
|
||||
* This software is licensed under the terms of the GNU General Public
|
||||
* License version 2, as published by the Free Software Foundation, and
|
||||
* may be copied, distributed, and modified under those terms.
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
*/
|
||||
#ifndef _ARCH_ARM_MACH_MSM_MSM_SMD_PRIVATE_H_
|
||||
#define _ARCH_ARM_MACH_MSM_MSM_SMD_PRIVATE_H_
|
||||
|
||||
struct smem_heap_info
|
||||
{
|
||||
unsigned initialized;
|
||||
unsigned free_offset;
|
||||
unsigned heap_remaining;
|
||||
unsigned reserved;
|
||||
};
|
||||
|
||||
struct smem_heap_entry
|
||||
{
|
||||
unsigned allocated;
|
||||
unsigned offset;
|
||||
unsigned size;
|
||||
unsigned reserved;
|
||||
};
|
||||
|
||||
struct smem_proc_comm
|
||||
{
|
||||
unsigned command;
|
||||
unsigned status;
|
||||
unsigned data1;
|
||||
unsigned data2;
|
||||
};
|
||||
|
||||
#define PC_APPS 0
|
||||
#define PC_MODEM 1
|
||||
|
||||
#define VERSION_QDSP6 4
|
||||
#define VERSION_APPS_SBL 6
|
||||
#define VERSION_MODEM_SBL 7
|
||||
#define VERSION_APPS 8
|
||||
#define VERSION_MODEM 9
|
||||
|
||||
struct smem_shared
|
||||
{
|
||||
struct smem_proc_comm proc_comm[4];
|
||||
unsigned version[32];
|
||||
struct smem_heap_info heap_info;
|
||||
struct smem_heap_entry heap_toc[128];
|
||||
};
|
||||
|
||||
struct smsm_shared
|
||||
{
|
||||
unsigned host;
|
||||
unsigned state;
|
||||
};
|
||||
|
||||
struct smsm_interrupt_info
|
||||
{
|
||||
uint32_t aArm_en_mask;
|
||||
uint32_t aArm_interrupts_pending;
|
||||
uint32_t aArm_wakeup_reason;
|
||||
};
|
||||
|
||||
#define SZ_DIAG_ERR_MSG 0xC8
|
||||
#define ID_DIAG_ERR_MSG SMEM_DIAG_ERR_MESSAGE
|
||||
#define ID_SMD_CHANNELS SMEM_SMD_BASE_ID
|
||||
#define ID_SHARED_STATE SMEM_SMSM_SHARED_STATE
|
||||
#define ID_CH_ALLOC_TBL SMEM_CHANNEL_ALLOC_TBL
|
||||
|
||||
#define SMSM_INIT 0x000001
|
||||
#define SMSM_SMDINIT 0x000008
|
||||
#define SMSM_RPCINIT 0x000020
|
||||
#define SMSM_RESET 0x000040
|
||||
#define SMSM_RSA 0x0080
|
||||
#define SMSM_RUN 0x000100
|
||||
#define SMSM_PWRC 0x0200
|
||||
#define SMSM_TIMEWAIT 0x0400
|
||||
#define SMSM_TIMEINIT 0x0800
|
||||
#define SMSM_PWRC_EARLY_EXIT 0x1000
|
||||
#define SMSM_WFPI 0x2000
|
||||
#define SMSM_SLEEP 0x4000
|
||||
#define SMSM_SLEEPEXIT 0x8000
|
||||
#define SMSM_OEMSBL_RELEASE 0x10000
|
||||
#define SMSM_PWRC_SUSPEND 0x200000
|
||||
|
||||
#define SMSM_WKUP_REASON_RPC 0x00000001
|
||||
#define SMSM_WKUP_REASON_INT 0x00000002
|
||||
#define SMSM_WKUP_REASON_GPIO 0x00000004
|
||||
#define SMSM_WKUP_REASON_TIMER 0x00000008
|
||||
#define SMSM_WKUP_REASON_ALARM 0x00000010
|
||||
#define SMSM_WKUP_REASON_RESET 0x00000020
|
||||
|
||||
void *smem_alloc(unsigned id, unsigned size);
|
||||
int smsm_change_state(uint32_t clear_mask, uint32_t set_mask);
|
||||
uint32_t smsm_get_state(void);
|
||||
int smsm_set_sleep_duration(uint32_t delay);
|
||||
int smsm_set_interrupt_info(struct smsm_interrupt_info *info);
|
||||
void smsm_print_sleep_info(void);
|
||||
|
||||
#define SMEM_NUM_SMD_CHANNELS 64
|
||||
|
||||
typedef enum
|
||||
{
|
||||
/* fixed items */
|
||||
SMEM_PROC_COMM = 0,
|
||||
SMEM_HEAP_INFO,
|
||||
SMEM_ALLOCATION_TABLE,
|
||||
SMEM_VERSION_INFO,
|
||||
SMEM_HW_RESET_DETECT,
|
||||
SMEM_AARM_WARM_BOOT,
|
||||
SMEM_DIAG_ERR_MESSAGE,
|
||||
SMEM_SPINLOCK_ARRAY,
|
||||
SMEM_MEMORY_BARRIER_LOCATION,
|
||||
|
||||
/* dynamic items */
|
||||
SMEM_AARM_PARTITION_TABLE,
|
||||
SMEM_AARM_BAD_BLOCK_TABLE,
|
||||
SMEM_RESERVE_BAD_BLOCKS,
|
||||
SMEM_WM_UUID,
|
||||
SMEM_CHANNEL_ALLOC_TBL,
|
||||
SMEM_SMD_BASE_ID,
|
||||
SMEM_SMEM_LOG_IDX = SMEM_SMD_BASE_ID + SMEM_NUM_SMD_CHANNELS,
|
||||
SMEM_SMEM_LOG_EVENTS,
|
||||
SMEM_SMEM_STATIC_LOG_IDX,
|
||||
SMEM_SMEM_STATIC_LOG_EVENTS,
|
||||
SMEM_SMEM_SLOW_CLOCK_SYNC,
|
||||
SMEM_SMEM_SLOW_CLOCK_VALUE,
|
||||
SMEM_BIO_LED_BUF,
|
||||
SMEM_SMSM_SHARED_STATE,
|
||||
SMEM_SMSM_INT_INFO,
|
||||
SMEM_SMSM_SLEEP_DELAY,
|
||||
SMEM_SMSM_LIMIT_SLEEP,
|
||||
SMEM_SLEEP_POWER_COLLAPSE_DISABLED,
|
||||
SMEM_KEYPAD_KEYS_PRESSED,
|
||||
SMEM_KEYPAD_STATE_UPDATED,
|
||||
SMEM_KEYPAD_STATE_IDX,
|
||||
SMEM_GPIO_INT,
|
||||
SMEM_MDDI_LCD_IDX,
|
||||
SMEM_MDDI_HOST_DRIVER_STATE,
|
||||
SMEM_MDDI_LCD_DISP_STATE,
|
||||
SMEM_LCD_CUR_PANEL,
|
||||
SMEM_MARM_BOOT_SEGMENT_INFO,
|
||||
SMEM_AARM_BOOT_SEGMENT_INFO,
|
||||
SMEM_SLEEP_STATIC,
|
||||
SMEM_SCORPION_FREQUENCY,
|
||||
SMEM_SMD_PROFILES,
|
||||
SMEM_TSSC_BUSY,
|
||||
SMEM_HS_SUSPEND_FILTER_INFO,
|
||||
SMEM_BATT_INFO,
|
||||
SMEM_APPS_BOOT_MODE,
|
||||
SMEM_VERSION_FIRST,
|
||||
SMEM_VERSION_LAST = SMEM_VERSION_FIRST + 24,
|
||||
SMEM_OSS_RRCASN1_BUF1,
|
||||
SMEM_OSS_RRCASN1_BUF2,
|
||||
SMEM_ID_VENDOR0,
|
||||
SMEM_ID_VENDOR1,
|
||||
SMEM_ID_VENDOR2,
|
||||
SMEM_HW_SW_BUILD_ID,
|
||||
SMEM_NUM_ITEMS,
|
||||
} smem_mem_type;
|
||||
|
||||
#endif
|
|
@ -0,0 +1,860 @@
|
|||
/* arch/arm/mach-msm/smd_qmi.c
|
||||
*
|
||||
* QMI Control Driver -- Manages network data connections.
|
||||
*
|
||||
* Copyright (C) 2007 Google, Inc.
|
||||
* Author: Brian Swetland <swetland@google.com>
|
||||
*
|
||||
* This software is licensed under the terms of the GNU General Public
|
||||
* License version 2, as published by the Free Software Foundation, and
|
||||
* may be copied, distributed, and modified under those terms.
|
||||
*
|
||||
* 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/module.h>
|
||||
#include <linux/fs.h>
|
||||
#include <linux/cdev.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/sched.h>
|
||||
#include <linux/wait.h>
|
||||
#include <linux/miscdevice.h>
|
||||
#include <linux/workqueue.h>
|
||||
#include <linux/wakelock.h>
|
||||
|
||||
#include <asm/uaccess.h>
|
||||
#include <mach/msm_smd.h>
|
||||
|
||||
#define QMI_CTL 0x00
|
||||
#define QMI_WDS 0x01
|
||||
#define QMI_DMS 0x02
|
||||
#define QMI_NAS 0x03
|
||||
|
||||
#define QMI_RESULT_SUCCESS 0x0000
|
||||
#define QMI_RESULT_FAILURE 0x0001
|
||||
|
||||
struct qmi_msg {
|
||||
unsigned char service;
|
||||
unsigned char client_id;
|
||||
unsigned short txn_id;
|
||||
unsigned short type;
|
||||
unsigned short size;
|
||||
unsigned char *tlv;
|
||||
};
|
||||
|
||||
#define qmi_ctl_client_id 0
|
||||
|
||||
#define STATE_OFFLINE 0
|
||||
#define STATE_QUERYING 1
|
||||
#define STATE_ONLINE 2
|
||||
|
||||
struct qmi_ctxt {
|
||||
struct miscdevice misc;
|
||||
|
||||
struct mutex lock;
|
||||
|
||||
unsigned char ctl_txn_id;
|
||||
unsigned char wds_client_id;
|
||||
unsigned short wds_txn_id;
|
||||
|
||||
unsigned wds_busy;
|
||||
unsigned wds_handle;
|
||||
unsigned state_dirty;
|
||||
unsigned state;
|
||||
|
||||
unsigned char addr[4];
|
||||
unsigned char mask[4];
|
||||
unsigned char gateway[4];
|
||||
unsigned char dns1[4];
|
||||
unsigned char dns2[4];
|
||||
|
||||
smd_channel_t *ch;
|
||||
const char *ch_name;
|
||||
struct wake_lock wake_lock;
|
||||
|
||||
struct work_struct open_work;
|
||||
struct work_struct read_work;
|
||||
};
|
||||
|
||||
static struct qmi_ctxt *qmi_minor_to_ctxt(unsigned n);
|
||||
|
||||
static void qmi_read_work(struct work_struct *ws);
|
||||
static void qmi_open_work(struct work_struct *work);
|
||||
|
||||
void qmi_ctxt_init(struct qmi_ctxt *ctxt, unsigned n)
|
||||
{
|
||||
mutex_init(&ctxt->lock);
|
||||
INIT_WORK(&ctxt->read_work, qmi_read_work);
|
||||
INIT_WORK(&ctxt->open_work, qmi_open_work);
|
||||
wake_lock_init(&ctxt->wake_lock, WAKE_LOCK_SUSPEND, ctxt->misc.name);
|
||||
ctxt->ctl_txn_id = 1;
|
||||
ctxt->wds_txn_id = 1;
|
||||
ctxt->wds_busy = 1;
|
||||
ctxt->state = STATE_OFFLINE;
|
||||
|
||||
}
|
||||
|
||||
static struct workqueue_struct *qmi_wq;
|
||||
|
||||
static int verbose = 0;
|
||||
|
||||
/* anyone waiting for a state change waits here */
|
||||
static DECLARE_WAIT_QUEUE_HEAD(qmi_wait_queue);
|
||||
|
||||
|
||||
static void qmi_dump_msg(struct qmi_msg *msg, const char *prefix)
|
||||
{
|
||||
unsigned sz, n;
|
||||
unsigned char *x;
|
||||
|
||||
if (!verbose)
|
||||
return;
|
||||
|
||||
printk(KERN_INFO
|
||||
"qmi: %s: svc=%02x cid=%02x tid=%04x type=%04x size=%04x\n",
|
||||
prefix, msg->service, msg->client_id,
|
||||
msg->txn_id, msg->type, msg->size);
|
||||
|
||||
x = msg->tlv;
|
||||
sz = msg->size;
|
||||
|
||||
while (sz >= 3) {
|
||||
sz -= 3;
|
||||
|
||||
n = x[1] | (x[2] << 8);
|
||||
if (n > sz)
|
||||
break;
|
||||
|
||||
printk(KERN_INFO "qmi: %s: tlv: %02x %04x { ",
|
||||
prefix, x[0], n);
|
||||
x += 3;
|
||||
sz -= n;
|
||||
while (n-- > 0)
|
||||
printk("%02x ", *x++);
|
||||
printk("}\n");
|
||||
}
|
||||
}
|
||||
|
||||
int qmi_add_tlv(struct qmi_msg *msg,
|
||||
unsigned type, unsigned size, const void *data)
|
||||
{
|
||||
unsigned char *x = msg->tlv + msg->size;
|
||||
|
||||
x[0] = type;
|
||||
x[1] = size;
|
||||
x[2] = size >> 8;
|
||||
|
||||
memcpy(x + 3, data, size);
|
||||
|
||||
msg->size += (size + 3);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Extract a tagged item from a qmi message buffer,
|
||||
** taking care not to overrun the buffer.
|
||||
*/
|
||||
static int qmi_get_tlv(struct qmi_msg *msg,
|
||||
unsigned type, unsigned size, void *data)
|
||||
{
|
||||
unsigned char *x = msg->tlv;
|
||||
unsigned len = msg->size;
|
||||
unsigned n;
|
||||
|
||||
while (len >= 3) {
|
||||
len -= 3;
|
||||
|
||||
/* size of this item */
|
||||
n = x[1] | (x[2] << 8);
|
||||
if (n > len)
|
||||
break;
|
||||
|
||||
if (x[0] == type) {
|
||||
if (n != size)
|
||||
return -1;
|
||||
memcpy(data, x + 3, size);
|
||||
return 0;
|
||||
}
|
||||
|
||||
x += (n + 3);
|
||||
len -= n;
|
||||
}
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
static unsigned qmi_get_status(struct qmi_msg *msg, unsigned *error)
|
||||
{
|
||||
unsigned short status[2];
|
||||
if (qmi_get_tlv(msg, 0x02, sizeof(status), status)) {
|
||||
*error = 0;
|
||||
return QMI_RESULT_FAILURE;
|
||||
} else {
|
||||
*error = status[1];
|
||||
return status[0];
|
||||
}
|
||||
}
|
||||
|
||||
/* 0x01 <qmux-header> <payload> */
|
||||
#define QMUX_HEADER 13
|
||||
|
||||
/* should be >= HEADER + FOOTER */
|
||||
#define QMUX_OVERHEAD 16
|
||||
|
||||
static int qmi_send(struct qmi_ctxt *ctxt, struct qmi_msg *msg)
|
||||
{
|
||||
unsigned char *data;
|
||||
unsigned hlen;
|
||||
unsigned len;
|
||||
int r;
|
||||
|
||||
qmi_dump_msg(msg, "send");
|
||||
|
||||
if (msg->service == QMI_CTL) {
|
||||
hlen = QMUX_HEADER - 1;
|
||||
} else {
|
||||
hlen = QMUX_HEADER;
|
||||
}
|
||||
|
||||
/* QMUX length is total header + total payload - IFC selector */
|
||||
len = hlen + msg->size - 1;
|
||||
if (len > 0xffff)
|
||||
return -1;
|
||||
|
||||
data = msg->tlv - hlen;
|
||||
|
||||
/* prepend encap and qmux header */
|
||||
*data++ = 0x01; /* ifc selector */
|
||||
|
||||
/* qmux header */
|
||||
*data++ = len;
|
||||
*data++ = len >> 8;
|
||||
*data++ = 0x00; /* flags: client */
|
||||
*data++ = msg->service;
|
||||
*data++ = msg->client_id;
|
||||
|
||||
/* qmi header */
|
||||
*data++ = 0x00; /* flags: send */
|
||||
*data++ = msg->txn_id;
|
||||
if (msg->service != QMI_CTL)
|
||||
*data++ = msg->txn_id >> 8;
|
||||
|
||||
*data++ = msg->type;
|
||||
*data++ = msg->type >> 8;
|
||||
*data++ = msg->size;
|
||||
*data++ = msg->size >> 8;
|
||||
|
||||
/* len + 1 takes the interface selector into account */
|
||||
r = smd_write(ctxt->ch, msg->tlv - hlen, len + 1);
|
||||
|
||||
if (r != len) {
|
||||
return -1;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
static void qmi_process_ctl_msg(struct qmi_ctxt *ctxt, struct qmi_msg *msg)
|
||||
{
|
||||
unsigned err;
|
||||
if (msg->type == 0x0022) {
|
||||
unsigned char n[2];
|
||||
if (qmi_get_status(msg, &err))
|
||||
return;
|
||||
if (qmi_get_tlv(msg, 0x01, sizeof(n), n))
|
||||
return;
|
||||
if (n[0] == QMI_WDS) {
|
||||
printk(KERN_INFO
|
||||
"qmi: ctl: wds use client_id 0x%02x\n", n[1]);
|
||||
ctxt->wds_client_id = n[1];
|
||||
ctxt->wds_busy = 0;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static int qmi_network_get_profile(struct qmi_ctxt *ctxt);
|
||||
|
||||
static void swapaddr(unsigned char *src, unsigned char *dst)
|
||||
{
|
||||
dst[0] = src[3];
|
||||
dst[1] = src[2];
|
||||
dst[2] = src[1];
|
||||
dst[3] = src[0];
|
||||
}
|
||||
|
||||
static unsigned char zero[4];
|
||||
static void qmi_read_runtime_profile(struct qmi_ctxt *ctxt, struct qmi_msg *msg)
|
||||
{
|
||||
unsigned char tmp[4];
|
||||
unsigned r;
|
||||
|
||||
r = qmi_get_tlv(msg, 0x1e, 4, tmp);
|
||||
swapaddr(r ? zero : tmp, ctxt->addr);
|
||||
r = qmi_get_tlv(msg, 0x21, 4, tmp);
|
||||
swapaddr(r ? zero : tmp, ctxt->mask);
|
||||
r = qmi_get_tlv(msg, 0x20, 4, tmp);
|
||||
swapaddr(r ? zero : tmp, ctxt->gateway);
|
||||
r = qmi_get_tlv(msg, 0x15, 4, tmp);
|
||||
swapaddr(r ? zero : tmp, ctxt->dns1);
|
||||
r = qmi_get_tlv(msg, 0x16, 4, tmp);
|
||||
swapaddr(r ? zero : tmp, ctxt->dns2);
|
||||
}
|
||||
|
||||
static void qmi_process_unicast_wds_msg(struct qmi_ctxt *ctxt,
|
||||
struct qmi_msg *msg)
|
||||
{
|
||||
unsigned err;
|
||||
switch (msg->type) {
|
||||
case 0x0021:
|
||||
if (qmi_get_status(msg, &err)) {
|
||||
printk(KERN_ERR
|
||||
"qmi: wds: network stop failed (%04x)\n", err);
|
||||
} else {
|
||||
printk(KERN_INFO
|
||||
"qmi: wds: network stopped\n");
|
||||
ctxt->state = STATE_OFFLINE;
|
||||
ctxt->state_dirty = 1;
|
||||
}
|
||||
break;
|
||||
case 0x0020:
|
||||
if (qmi_get_status(msg, &err)) {
|
||||
printk(KERN_ERR
|
||||
"qmi: wds: network start failed (%04x)\n", err);
|
||||
} else if (qmi_get_tlv(msg, 0x01, sizeof(ctxt->wds_handle), &ctxt->wds_handle)) {
|
||||
printk(KERN_INFO
|
||||
"qmi: wds no handle?\n");
|
||||
} else {
|
||||
printk(KERN_INFO
|
||||
"qmi: wds: got handle 0x%08x\n",
|
||||
ctxt->wds_handle);
|
||||
}
|
||||
break;
|
||||
case 0x002D:
|
||||
printk("qmi: got network profile\n");
|
||||
if (ctxt->state == STATE_QUERYING) {
|
||||
qmi_read_runtime_profile(ctxt, msg);
|
||||
ctxt->state = STATE_ONLINE;
|
||||
ctxt->state_dirty = 1;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
printk(KERN_ERR "qmi: unknown msg type 0x%04x\n", msg->type);
|
||||
}
|
||||
ctxt->wds_busy = 0;
|
||||
}
|
||||
|
||||
static void qmi_process_broadcast_wds_msg(struct qmi_ctxt *ctxt,
|
||||
struct qmi_msg *msg)
|
||||
{
|
||||
if (msg->type == 0x0022) {
|
||||
unsigned char n[2];
|
||||
if (qmi_get_tlv(msg, 0x01, sizeof(n), n))
|
||||
return;
|
||||
switch (n[0]) {
|
||||
case 1:
|
||||
printk(KERN_INFO "qmi: wds: DISCONNECTED\n");
|
||||
ctxt->state = STATE_OFFLINE;
|
||||
ctxt->state_dirty = 1;
|
||||
break;
|
||||
case 2:
|
||||
printk(KERN_INFO "qmi: wds: CONNECTED\n");
|
||||
ctxt->state = STATE_QUERYING;
|
||||
ctxt->state_dirty = 1;
|
||||
qmi_network_get_profile(ctxt);
|
||||
break;
|
||||
case 3:
|
||||
printk(KERN_INFO "qmi: wds: SUSPENDED\n");
|
||||
ctxt->state = STATE_OFFLINE;
|
||||
ctxt->state_dirty = 1;
|
||||
}
|
||||
} else {
|
||||
printk(KERN_ERR "qmi: unknown bcast msg type 0x%04x\n", msg->type);
|
||||
}
|
||||
}
|
||||
|
||||
static void qmi_process_wds_msg(struct qmi_ctxt *ctxt,
|
||||
struct qmi_msg *msg)
|
||||
{
|
||||
printk("wds: %04x @ %02x\n", msg->type, msg->client_id);
|
||||
if (msg->client_id == ctxt->wds_client_id) {
|
||||
qmi_process_unicast_wds_msg(ctxt, msg);
|
||||
} else if (msg->client_id == 0xff) {
|
||||
qmi_process_broadcast_wds_msg(ctxt, msg);
|
||||
} else {
|
||||
printk(KERN_ERR
|
||||
"qmi_process_wds_msg client id 0x%02x unknown\n",
|
||||
msg->client_id);
|
||||
}
|
||||
}
|
||||
|
||||
static void qmi_process_qmux(struct qmi_ctxt *ctxt,
|
||||
unsigned char *buf, unsigned sz)
|
||||
{
|
||||
struct qmi_msg msg;
|
||||
|
||||
/* require a full header */
|
||||
if (sz < 5)
|
||||
return;
|
||||
|
||||
/* require a size that matches the buffer size */
|
||||
if (sz != (buf[0] | (buf[1] << 8)))
|
||||
return;
|
||||
|
||||
/* only messages from a service (bit7=1) are allowed */
|
||||
if (buf[2] != 0x80)
|
||||
return;
|
||||
|
||||
msg.service = buf[3];
|
||||
msg.client_id = buf[4];
|
||||
|
||||
/* annoyingly, CTL messages have a shorter TID */
|
||||
if (buf[3] == 0) {
|
||||
if (sz < 7)
|
||||
return;
|
||||
msg.txn_id = buf[6];
|
||||
buf += 7;
|
||||
sz -= 7;
|
||||
} else {
|
||||
if (sz < 8)
|
||||
return;
|
||||
msg.txn_id = buf[6] | (buf[7] << 8);
|
||||
buf += 8;
|
||||
sz -= 8;
|
||||
}
|
||||
|
||||
/* no type and size!? */
|
||||
if (sz < 4)
|
||||
return;
|
||||
sz -= 4;
|
||||
|
||||
msg.type = buf[0] | (buf[1] << 8);
|
||||
msg.size = buf[2] | (buf[3] << 8);
|
||||
msg.tlv = buf + 4;
|
||||
|
||||
if (sz != msg.size)
|
||||
return;
|
||||
|
||||
qmi_dump_msg(&msg, "recv");
|
||||
|
||||
mutex_lock(&ctxt->lock);
|
||||
switch (msg.service) {
|
||||
case QMI_CTL:
|
||||
qmi_process_ctl_msg(ctxt, &msg);
|
||||
break;
|
||||
case QMI_WDS:
|
||||
qmi_process_wds_msg(ctxt, &msg);
|
||||
break;
|
||||
default:
|
||||
printk(KERN_ERR "qmi: msg from unknown svc 0x%02x\n",
|
||||
msg.service);
|
||||
break;
|
||||
}
|
||||
mutex_unlock(&ctxt->lock);
|
||||
|
||||
wake_up(&qmi_wait_queue);
|
||||
}
|
||||
|
||||
#define QMI_MAX_PACKET (256 + QMUX_OVERHEAD)
|
||||
|
||||
static void qmi_read_work(struct work_struct *ws)
|
||||
{
|
||||
struct qmi_ctxt *ctxt = container_of(ws, struct qmi_ctxt, read_work);
|
||||
struct smd_channel *ch = ctxt->ch;
|
||||
unsigned char buf[QMI_MAX_PACKET];
|
||||
int sz;
|
||||
|
||||
for (;;) {
|
||||
sz = smd_cur_packet_size(ch);
|
||||
if (sz == 0)
|
||||
break;
|
||||
if (sz < smd_read_avail(ch))
|
||||
break;
|
||||
if (sz > QMI_MAX_PACKET) {
|
||||
smd_read(ch, 0, sz);
|
||||
continue;
|
||||
}
|
||||
if (smd_read(ch, buf, sz) != sz) {
|
||||
printk(KERN_ERR "qmi: not enough data?!\n");
|
||||
continue;
|
||||
}
|
||||
|
||||
/* interface selector must be 1 */
|
||||
if (buf[0] != 0x01)
|
||||
continue;
|
||||
|
||||
qmi_process_qmux(ctxt, buf + 1, sz - 1);
|
||||
}
|
||||
}
|
||||
|
||||
static int qmi_request_wds_cid(struct qmi_ctxt *ctxt);
|
||||
|
||||
static void qmi_open_work(struct work_struct *ws)
|
||||
{
|
||||
struct qmi_ctxt *ctxt = container_of(ws, struct qmi_ctxt, open_work);
|
||||
mutex_lock(&ctxt->lock);
|
||||
qmi_request_wds_cid(ctxt);
|
||||
mutex_unlock(&ctxt->lock);
|
||||
}
|
||||
|
||||
static void qmi_notify(void *priv, unsigned event)
|
||||
{
|
||||
struct qmi_ctxt *ctxt = priv;
|
||||
|
||||
switch (event) {
|
||||
case SMD_EVENT_DATA: {
|
||||
int sz;
|
||||
sz = smd_cur_packet_size(ctxt->ch);
|
||||
if ((sz > 0) && (sz <= smd_read_avail(ctxt->ch))) {
|
||||
wake_lock_timeout(&ctxt->wake_lock, HZ / 2);
|
||||
queue_work(qmi_wq, &ctxt->read_work);
|
||||
}
|
||||
break;
|
||||
}
|
||||
case SMD_EVENT_OPEN:
|
||||
printk(KERN_INFO "qmi: smd opened\n");
|
||||
queue_work(qmi_wq, &ctxt->open_work);
|
||||
break;
|
||||
case SMD_EVENT_CLOSE:
|
||||
printk(KERN_INFO "qmi: smd closed\n");
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static int qmi_request_wds_cid(struct qmi_ctxt *ctxt)
|
||||
{
|
||||
unsigned char data[64 + QMUX_OVERHEAD];
|
||||
struct qmi_msg msg;
|
||||
unsigned char n;
|
||||
|
||||
msg.service = QMI_CTL;
|
||||
msg.client_id = qmi_ctl_client_id;
|
||||
msg.txn_id = ctxt->ctl_txn_id;
|
||||
msg.type = 0x0022;
|
||||
msg.size = 0;
|
||||
msg.tlv = data + QMUX_HEADER;
|
||||
|
||||
ctxt->ctl_txn_id += 2;
|
||||
|
||||
n = QMI_WDS;
|
||||
qmi_add_tlv(&msg, 0x01, 0x01, &n);
|
||||
|
||||
return qmi_send(ctxt, &msg);
|
||||
}
|
||||
|
||||
static int qmi_network_get_profile(struct qmi_ctxt *ctxt)
|
||||
{
|
||||
unsigned char data[96 + QMUX_OVERHEAD];
|
||||
struct qmi_msg msg;
|
||||
|
||||
msg.service = QMI_WDS;
|
||||
msg.client_id = ctxt->wds_client_id;
|
||||
msg.txn_id = ctxt->wds_txn_id;
|
||||
msg.type = 0x002D;
|
||||
msg.size = 0;
|
||||
msg.tlv = data + QMUX_HEADER;
|
||||
|
||||
ctxt->wds_txn_id += 2;
|
||||
|
||||
return qmi_send(ctxt, &msg);
|
||||
}
|
||||
|
||||
static int qmi_network_up(struct qmi_ctxt *ctxt, char *apn)
|
||||
{
|
||||
unsigned char data[96 + QMUX_OVERHEAD];
|
||||
struct qmi_msg msg;
|
||||
char *auth_type;
|
||||
char *user;
|
||||
char *pass;
|
||||
|
||||
for (user = apn; *user; user++) {
|
||||
if (*user == ' ') {
|
||||
*user++ = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
for (pass = user; *pass; pass++) {
|
||||
if (*pass == ' ') {
|
||||
*pass++ = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
for (auth_type = pass; *auth_type; auth_type++) {
|
||||
if (*auth_type == ' ') {
|
||||
*auth_type++ = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
msg.service = QMI_WDS;
|
||||
msg.client_id = ctxt->wds_client_id;
|
||||
msg.txn_id = ctxt->wds_txn_id;
|
||||
msg.type = 0x0020;
|
||||
msg.size = 0;
|
||||
msg.tlv = data + QMUX_HEADER;
|
||||
|
||||
ctxt->wds_txn_id += 2;
|
||||
|
||||
qmi_add_tlv(&msg, 0x14, strlen(apn), apn);
|
||||
if (*auth_type)
|
||||
qmi_add_tlv(&msg, 0x16, strlen(auth_type), auth_type);
|
||||
if (*user) {
|
||||
if (!*auth_type) {
|
||||
unsigned char x;
|
||||
x = 3;
|
||||
qmi_add_tlv(&msg, 0x16, 1, &x);
|
||||
}
|
||||
qmi_add_tlv(&msg, 0x17, strlen(user), user);
|
||||
if (*pass)
|
||||
qmi_add_tlv(&msg, 0x18, strlen(pass), pass);
|
||||
}
|
||||
return qmi_send(ctxt, &msg);
|
||||
}
|
||||
|
||||
static int qmi_network_down(struct qmi_ctxt *ctxt)
|
||||
{
|
||||
unsigned char data[16 + QMUX_OVERHEAD];
|
||||
struct qmi_msg msg;
|
||||
|
||||
msg.service = QMI_WDS;
|
||||
msg.client_id = ctxt->wds_client_id;
|
||||
msg.txn_id = ctxt->wds_txn_id;
|
||||
msg.type = 0x0021;
|
||||
msg.size = 0;
|
||||
msg.tlv = data + QMUX_HEADER;
|
||||
|
||||
ctxt->wds_txn_id += 2;
|
||||
|
||||
qmi_add_tlv(&msg, 0x01, sizeof(ctxt->wds_handle), &ctxt->wds_handle);
|
||||
|
||||
return qmi_send(ctxt, &msg);
|
||||
}
|
||||
|
||||
static int qmi_print_state(struct qmi_ctxt *ctxt, char *buf, int max)
|
||||
{
|
||||
int i;
|
||||
char *statename;
|
||||
|
||||
if (ctxt->state == STATE_ONLINE) {
|
||||
statename = "up";
|
||||
} else if (ctxt->state == STATE_OFFLINE) {
|
||||
statename = "down";
|
||||
} else {
|
||||
statename = "busy";
|
||||
}
|
||||
|
||||
i = scnprintf(buf, max, "STATE=%s\n", statename);
|
||||
i += scnprintf(buf + i, max - i, "CID=%d\n",ctxt->wds_client_id);
|
||||
|
||||
if (ctxt->state != STATE_ONLINE){
|
||||
return i;
|
||||
}
|
||||
|
||||
i += scnprintf(buf + i, max - i, "ADDR=%d.%d.%d.%d\n",
|
||||
ctxt->addr[0], ctxt->addr[1], ctxt->addr[2], ctxt->addr[3]);
|
||||
i += scnprintf(buf + i, max - i, "MASK=%d.%d.%d.%d\n",
|
||||
ctxt->mask[0], ctxt->mask[1], ctxt->mask[2], ctxt->mask[3]);
|
||||
i += scnprintf(buf + i, max - i, "GATEWAY=%d.%d.%d.%d\n",
|
||||
ctxt->gateway[0], ctxt->gateway[1], ctxt->gateway[2],
|
||||
ctxt->gateway[3]);
|
||||
i += scnprintf(buf + i, max - i, "DNS1=%d.%d.%d.%d\n",
|
||||
ctxt->dns1[0], ctxt->dns1[1], ctxt->dns1[2], ctxt->dns1[3]);
|
||||
i += scnprintf(buf + i, max - i, "DNS2=%d.%d.%d.%d\n",
|
||||
ctxt->dns2[0], ctxt->dns2[1], ctxt->dns2[2], ctxt->dns2[3]);
|
||||
|
||||
return i;
|
||||
}
|
||||
|
||||
static ssize_t qmi_read(struct file *fp, char __user *buf,
|
||||
size_t count, loff_t *pos)
|
||||
{
|
||||
struct qmi_ctxt *ctxt = fp->private_data;
|
||||
char msg[256];
|
||||
int len;
|
||||
int r;
|
||||
|
||||
mutex_lock(&ctxt->lock);
|
||||
for (;;) {
|
||||
if (ctxt->state_dirty) {
|
||||
ctxt->state_dirty = 0;
|
||||
len = qmi_print_state(ctxt, msg, 256);
|
||||
break;
|
||||
}
|
||||
mutex_unlock(&ctxt->lock);
|
||||
r = wait_event_interruptible(qmi_wait_queue, ctxt->state_dirty);
|
||||
if (r < 0)
|
||||
return r;
|
||||
mutex_lock(&ctxt->lock);
|
||||
}
|
||||
mutex_unlock(&ctxt->lock);
|
||||
|
||||
if (len > count)
|
||||
len = count;
|
||||
|
||||
if (copy_to_user(buf, msg, len))
|
||||
return -EFAULT;
|
||||
|
||||
return len;
|
||||
}
|
||||
|
||||
|
||||
static ssize_t qmi_write(struct file *fp, const char __user *buf,
|
||||
size_t count, loff_t *pos)
|
||||
{
|
||||
struct qmi_ctxt *ctxt = fp->private_data;
|
||||
unsigned char cmd[64];
|
||||
int len;
|
||||
int r;
|
||||
|
||||
if (count < 1)
|
||||
return 0;
|
||||
|
||||
len = count > 63 ? 63 : count;
|
||||
|
||||
if (copy_from_user(cmd, buf, len))
|
||||
return -EFAULT;
|
||||
|
||||
cmd[len] = 0;
|
||||
|
||||
/* lazy */
|
||||
if (cmd[len-1] == '\n') {
|
||||
cmd[len-1] = 0;
|
||||
len--;
|
||||
}
|
||||
|
||||
if (!strncmp(cmd, "verbose", 7)) {
|
||||
verbose = 1;
|
||||
} else if (!strncmp(cmd, "terse", 5)) {
|
||||
verbose = 0;
|
||||
} else if (!strncmp(cmd, "poll", 4)) {
|
||||
ctxt->state_dirty = 1;
|
||||
wake_up(&qmi_wait_queue);
|
||||
} else if (!strncmp(cmd, "down", 4)) {
|
||||
retry_down:
|
||||
mutex_lock(&ctxt->lock);
|
||||
if (ctxt->wds_busy) {
|
||||
mutex_unlock(&ctxt->lock);
|
||||
r = wait_event_interruptible(qmi_wait_queue, !ctxt->wds_busy);
|
||||
if (r < 0)
|
||||
return r;
|
||||
goto retry_down;
|
||||
}
|
||||
ctxt->wds_busy = 1;
|
||||
qmi_network_down(ctxt);
|
||||
mutex_unlock(&ctxt->lock);
|
||||
} else if (!strncmp(cmd, "up:", 3)) {
|
||||
retry_up:
|
||||
mutex_lock(&ctxt->lock);
|
||||
if (ctxt->wds_busy) {
|
||||
mutex_unlock(&ctxt->lock);
|
||||
r = wait_event_interruptible(qmi_wait_queue, !ctxt->wds_busy);
|
||||
if (r < 0)
|
||||
return r;
|
||||
goto retry_up;
|
||||
}
|
||||
ctxt->wds_busy = 1;
|
||||
qmi_network_up(ctxt, cmd+3);
|
||||
mutex_unlock(&ctxt->lock);
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
static int qmi_open(struct inode *ip, struct file *fp)
|
||||
{
|
||||
struct qmi_ctxt *ctxt = qmi_minor_to_ctxt(MINOR(ip->i_rdev));
|
||||
int r = 0;
|
||||
|
||||
if (!ctxt) {
|
||||
printk(KERN_ERR "unknown qmi misc %d\n", MINOR(ip->i_rdev));
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
fp->private_data = ctxt;
|
||||
|
||||
mutex_lock(&ctxt->lock);
|
||||
if (ctxt->ch == 0)
|
||||
r = smd_open(ctxt->ch_name, &ctxt->ch, ctxt, qmi_notify);
|
||||
if (r == 0)
|
||||
wake_up(&qmi_wait_queue);
|
||||
mutex_unlock(&ctxt->lock);
|
||||
|
||||
return r;
|
||||
}
|
||||
|
||||
static int qmi_release(struct inode *ip, struct file *fp)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct file_operations qmi_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.read = qmi_read,
|
||||
.write = qmi_write,
|
||||
.open = qmi_open,
|
||||
.release = qmi_release,
|
||||
};
|
||||
|
||||
static struct qmi_ctxt qmi_device0 = {
|
||||
.ch_name = "SMD_DATA5_CNTL",
|
||||
.misc = {
|
||||
.minor = MISC_DYNAMIC_MINOR,
|
||||
.name = "qmi0",
|
||||
.fops = &qmi_fops,
|
||||
}
|
||||
};
|
||||
static struct qmi_ctxt qmi_device1 = {
|
||||
.ch_name = "SMD_DATA6_CNTL",
|
||||
.misc = {
|
||||
.minor = MISC_DYNAMIC_MINOR,
|
||||
.name = "qmi1",
|
||||
.fops = &qmi_fops,
|
||||
}
|
||||
};
|
||||
static struct qmi_ctxt qmi_device2 = {
|
||||
.ch_name = "SMD_DATA7_CNTL",
|
||||
.misc = {
|
||||
.minor = MISC_DYNAMIC_MINOR,
|
||||
.name = "qmi2",
|
||||
.fops = &qmi_fops,
|
||||
}
|
||||
};
|
||||
|
||||
static struct qmi_ctxt *qmi_minor_to_ctxt(unsigned n)
|
||||
{
|
||||
if (n == qmi_device0.misc.minor)
|
||||
return &qmi_device0;
|
||||
if (n == qmi_device1.misc.minor)
|
||||
return &qmi_device1;
|
||||
if (n == qmi_device2.misc.minor)
|
||||
return &qmi_device2;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __init qmi_init(void)
|
||||
{
|
||||
int ret;
|
||||
|
||||
qmi_wq = create_singlethread_workqueue("qmi");
|
||||
if (qmi_wq == 0)
|
||||
return -ENOMEM;
|
||||
|
||||
qmi_ctxt_init(&qmi_device0, 0);
|
||||
qmi_ctxt_init(&qmi_device1, 1);
|
||||
qmi_ctxt_init(&qmi_device2, 2);
|
||||
|
||||
ret = misc_register(&qmi_device0.misc);
|
||||
if (ret == 0)
|
||||
ret = misc_register(&qmi_device1.misc);
|
||||
if (ret == 0)
|
||||
ret = misc_register(&qmi_device2.misc);
|
||||
return ret;
|
||||
}
|
||||
|
||||
module_init(qmi_init);
|
|
@ -0,0 +1,213 @@
|
|||
/* arch/arm/mach-msm/smd_tty.c
|
||||
*
|
||||
* Copyright (C) 2007 Google, Inc.
|
||||
* Author: Brian Swetland <swetland@google.com>
|
||||
*
|
||||
* This software is licensed under the terms of the GNU General Public
|
||||
* License version 2, as published by the Free Software Foundation, and
|
||||
* may be copied, distributed, and modified under those terms.
|
||||
*
|
||||
* 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/module.h>
|
||||
#include <linux/fs.h>
|
||||
#include <linux/cdev.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/wait.h>
|
||||
#include <linux/wakelock.h>
|
||||
|
||||
#include <linux/tty.h>
|
||||
#include <linux/tty_driver.h>
|
||||
#include <linux/tty_flip.h>
|
||||
|
||||
#include <mach/msm_smd.h>
|
||||
|
||||
#define MAX_SMD_TTYS 32
|
||||
|
||||
static DEFINE_MUTEX(smd_tty_lock);
|
||||
|
||||
struct smd_tty_info {
|
||||
smd_channel_t *ch;
|
||||
struct tty_struct *tty;
|
||||
struct wake_lock wake_lock;
|
||||
int open_count;
|
||||
};
|
||||
|
||||
static struct smd_tty_info smd_tty[MAX_SMD_TTYS];
|
||||
|
||||
|
||||
static void smd_tty_notify(void *priv, unsigned event)
|
||||
{
|
||||
unsigned char *ptr;
|
||||
int avail;
|
||||
struct smd_tty_info *info = priv;
|
||||
struct tty_struct *tty = info->tty;
|
||||
|
||||
if (!tty)
|
||||
return;
|
||||
|
||||
if (event != SMD_EVENT_DATA)
|
||||
return;
|
||||
|
||||
for (;;) {
|
||||
if (test_bit(TTY_THROTTLED, &tty->flags)) break;
|
||||
avail = smd_read_avail(info->ch);
|
||||
if (avail == 0) break;
|
||||
|
||||
avail = tty_prepare_flip_string(tty, &ptr, avail);
|
||||
|
||||
if (smd_read(info->ch, ptr, avail) != avail) {
|
||||
/* shouldn't be possible since we're in interrupt
|
||||
** context here and nobody else could 'steal' our
|
||||
** characters.
|
||||
*/
|
||||
printk(KERN_ERR "OOPS - smd_tty_buffer mismatch?!");
|
||||
}
|
||||
|
||||
wake_lock_timeout(&info->wake_lock, HZ / 2);
|
||||
tty_flip_buffer_push(tty);
|
||||
}
|
||||
|
||||
/* XXX only when writable and necessary */
|
||||
tty_wakeup(tty);
|
||||
}
|
||||
|
||||
static int smd_tty_open(struct tty_struct *tty, struct file *f)
|
||||
{
|
||||
int res = 0;
|
||||
int n = tty->index;
|
||||
struct smd_tty_info *info;
|
||||
const char *name;
|
||||
|
||||
if (n == 0) {
|
||||
name = "SMD_DS";
|
||||
} else if (n == 27) {
|
||||
name = "SMD_GPSNMEA";
|
||||
} else {
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
info = smd_tty + n;
|
||||
|
||||
mutex_lock(&smd_tty_lock);
|
||||
wake_lock_init(&info->wake_lock, WAKE_LOCK_SUSPEND, name);
|
||||
tty->driver_data = info;
|
||||
|
||||
if (info->open_count++ == 0) {
|
||||
info->tty = tty;
|
||||
if (info->ch) {
|
||||
smd_kick(info->ch);
|
||||
} else {
|
||||
res = smd_open(name, &info->ch, info, smd_tty_notify);
|
||||
}
|
||||
}
|
||||
mutex_unlock(&smd_tty_lock);
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
static void smd_tty_close(struct tty_struct *tty, struct file *f)
|
||||
{
|
||||
struct smd_tty_info *info = tty->driver_data;
|
||||
|
||||
if (info == 0)
|
||||
return;
|
||||
|
||||
mutex_lock(&smd_tty_lock);
|
||||
if (--info->open_count == 0) {
|
||||
info->tty = 0;
|
||||
tty->driver_data = 0;
|
||||
wake_lock_destroy(&info->wake_lock);
|
||||
if (info->ch) {
|
||||
smd_close(info->ch);
|
||||
info->ch = 0;
|
||||
}
|
||||
}
|
||||
mutex_unlock(&smd_tty_lock);
|
||||
}
|
||||
|
||||
static int smd_tty_write(struct tty_struct *tty, const unsigned char *buf, int len)
|
||||
{
|
||||
struct smd_tty_info *info = tty->driver_data;
|
||||
int avail;
|
||||
|
||||
/* if we're writing to a packet channel we will
|
||||
** never be able to write more data than there
|
||||
** is currently space for
|
||||
*/
|
||||
avail = smd_write_avail(info->ch);
|
||||
if (len > avail)
|
||||
len = avail;
|
||||
|
||||
return smd_write(info->ch, buf, len);
|
||||
}
|
||||
|
||||
static int smd_tty_write_room(struct tty_struct *tty)
|
||||
{
|
||||
struct smd_tty_info *info = tty->driver_data;
|
||||
return smd_write_avail(info->ch);
|
||||
}
|
||||
|
||||
static int smd_tty_chars_in_buffer(struct tty_struct *tty)
|
||||
{
|
||||
struct smd_tty_info *info = tty->driver_data;
|
||||
return smd_read_avail(info->ch);
|
||||
}
|
||||
|
||||
static void smd_tty_unthrottle(struct tty_struct *tty)
|
||||
{
|
||||
struct smd_tty_info *info = tty->driver_data;
|
||||
smd_kick(info->ch);
|
||||
}
|
||||
|
||||
static struct tty_operations smd_tty_ops = {
|
||||
.open = smd_tty_open,
|
||||
.close = smd_tty_close,
|
||||
.write = smd_tty_write,
|
||||
.write_room = smd_tty_write_room,
|
||||
.chars_in_buffer = smd_tty_chars_in_buffer,
|
||||
.unthrottle = smd_tty_unthrottle,
|
||||
};
|
||||
|
||||
static struct tty_driver *smd_tty_driver;
|
||||
|
||||
static int __init smd_tty_init(void)
|
||||
{
|
||||
int ret;
|
||||
|
||||
smd_tty_driver = alloc_tty_driver(MAX_SMD_TTYS);
|
||||
if (smd_tty_driver == 0)
|
||||
return -ENOMEM;
|
||||
|
||||
smd_tty_driver->owner = THIS_MODULE;
|
||||
smd_tty_driver->driver_name = "smd_tty_driver";
|
||||
smd_tty_driver->name = "smd";
|
||||
smd_tty_driver->major = 0;
|
||||
smd_tty_driver->minor_start = 0;
|
||||
smd_tty_driver->type = TTY_DRIVER_TYPE_SERIAL;
|
||||
smd_tty_driver->subtype = SERIAL_TYPE_NORMAL;
|
||||
smd_tty_driver->init_termios = tty_std_termios;
|
||||
smd_tty_driver->init_termios.c_iflag = 0;
|
||||
smd_tty_driver->init_termios.c_oflag = 0;
|
||||
smd_tty_driver->init_termios.c_cflag = B38400 | CS8 | CREAD;
|
||||
smd_tty_driver->init_termios.c_lflag = 0;
|
||||
smd_tty_driver->flags = TTY_DRIVER_RESET_TERMIOS |
|
||||
TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
|
||||
tty_set_operations(smd_tty_driver, &smd_tty_ops);
|
||||
|
||||
ret = tty_register_driver(smd_tty_driver);
|
||||
if (ret) return ret;
|
||||
|
||||
/* this should be dynamic */
|
||||
tty_register_device(smd_tty_driver, 0, 0);
|
||||
tty_register_device(smd_tty_driver, 27, 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
module_init(smd_tty_init);
|
Loading…
Reference in New Issue