drivers:staging: sources for Init manager module
Quoted 1,317 lines · --- On Fri, 26/3/10, [email protected] <[email protected]> wrote:
From: [email protected] <[email protected]>
Subject: [PATCH] drivers:staging: sources for Init manager module
To: [email protected], [email protected], [email protected]
Cc: [email protected], [email protected], "Pavan Savoy" <[email protected]>
Date: Friday, 26 March, 2010, 4:50 AM
From: Pavan Savoy <[email protected]>Kernel Space Init-Manager works along with User-Mode Init Manager daemon running to maintain the UART state.
Communication between user-space daemon and this module can be
1. Via the pid written onto sysfs entry
2. Via the rfkill subsystemIt also is a platform driver with a relevant platform device
in the board-*.c along with the list of BT/FM/GPS chip enable
gpio configurationSigned-off-by Pavan Savoy <[email protected]>--- drivers/staging/ti-st/st_kim.c | 747 ++++++++++++++++++++++++++++++++++++++++ drivers/staging/ti-st/st_kim.h | 152 ++++++++ 2 files changed, 899 insertions(+), 0 deletions(-) create mode 100644 drivers/staging/ti-st/st_kim.c create mode 100644 drivers/staging/ti-st/st_kim.hdrivers/staging/ti-st/st_kim.c new file +3
-0@@ -0,0 +1,747 @@ +/* +* Shared Transport Line discipline driver Core +* Init Manager module responsible for GPIO control
+ * and firmware download
+ * Copyright (C) 2009 Texas Instruments
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License 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.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ *
+ */drivers/staging/ti-st/st_kim.c new file +19
-0+ +#include <linux/platform_device.h> +#include <linux/jiffies.h> +#include <linux/firmware.h> +#include <linux/delay.h> +#include <linux/wait.h> +#include <linux/gpio.h> + +#include <linux/sched.h> + +#include "st_kim.h" +/* understand BT events for fw response */ +#include <net/bluetooth/bluetooth.h> +#include <net/bluetooth/hci_core.h> +#include <net/bluetooth/hci.h> + + +/* all debug macros go in here */ +#define ST_KIM_ERR(fmt, arg...) printk(KERN_ERR"(stk):"fmt"\n" , ## arg)
+#if defined(DEBUG) /*
limited debug messages */
+#defineST_KIM_DBG(fmt, arg...)printk(KERN_INFO "(stk):"fmt"\n" , ## arg)drivers/staging/ti-st/st_kim.c new file +3
-0+#define ST_KIM_VER(fmt, arg...) +#elif defined(VERBOSE )/* very verbose */ +#define ST_KIM_DBG(fmt, arg...) printk(KERN_INFO"(stk):"fmt"\n" , ## arg)
+#defineST_KIM_VER(fmt, arg...)printk(KERN_INFO "(stk):"fmt"\n" , ## arg)drivers/staging/ti-st/st_kim.c new file +13
-0+#else /* error msgs only */ +#define ST_KIM_DBG(fmt, arg...) +#define ST_KIM_VER(fmt, arg...) +#endif + +static int kim_probe (struct platform_device *pdev); +static int kim_remove (struct platform_device *pdev); + +/* KIM platform device driver structure */ +static struct platform_driver kim_platform_driver = { + .probe = kim_probe, + .remove = kim_remove, +/* TODO: ST driver power management during suspend/resume ?
drivers/staging/ti-st/st_kim.c new file +13
-0+*/ +#if 0 + .suspend = kim_suspend, + .resume = kim_resume, +#endif + .driver = { + .name = "kim", + .owner = THIS_MODULE, + }, +}; + +#ifndef LEGACY_RFKILL_SUPPORT +static ssize_t show_pid(struct device *dev, struct
device_attribute
+
*attr, char *buf);
+staticssize_tstore_pid(struct device *dev, structdevice_attribute
+
*devattr, char *buf,size_t
count);
+staticssize_tshow_list(struct device *dev, structdevice_attributedrivers/staging/ti-st/st_kim.c new file +43
-0+ *attr, char *buf); + +/* structures specific for sysfs entries */ +static struct kobj_attribute pid_attr = +__ATTR (pid,0644 , (void *)show_pid, (void *)store_pid); + +static struct kobj_attribute list_protocols = +__ATTR (protocols,0444 , (void *)show_list,NULL ); + +static struct attribute *uim_attrs[] = { + &pid_attr.attr, +/* add more debug sysfs entries */ + &list_protocols.attr, +NULL , +}; + +static struct attribute_group uim_attr_grp = { + .attrs = uim_attrs, +}; +#else +static int kim_toggle_radio (void *,bool ); +static const struct rfkill_ops kim_rfkill_ops = { + .set_block = kim_toggle_radio, +}; +#endif /* LEGACY_RFKILL_SUPPORT */ + +/* strings to be used for rfkill entries and by +* ST Core to be used for sysfs debug entry +*/ +#define PROTO_ENTRY (type, name) name +const unsigned char *protocol_names[] = { +PROTO_ENTRY (ST_BT ,"Bluetooth" ), +PROTO_ENTRY (ST_FM ,"FM" ), +PROTO_ENTRY (ST_GPS ,"GPS" ), +}; + +static struct kim_data_s *kim_gdata; + +/**********************************************************************/ +/* internal functions */ + +/* +* function to return whether the firmware response was proper
+ * in case of error don't complete so that waiting for proper
+ * response times out
+ */drivers/staging/ti-st/st_kim.c new file +4
-0+void validate_firmware_response (struct sk_buff *skb) +{ +if (unlikely (skb->data[5 ] !=0 )) { + ST_KIM_ERR("noproper response during fw download");
+ ST_KIM_ERR("data6
%x", skb->data[5]);
+
return; /* keep waiting
for the proper response */drivers/staging/ti-st/st_kim.c new file +2
-0+ } +/* becos of all the script being downloaded */
+complete_all(&kim_gdata->kim_rcvd);drivers/staging/ti-st/st_kim.c new file +5
-0+kfree_skb (skb); +} + +/* check for data len received inside kim_int_recv +* most often hit the last case to update state to waiting for data
+ */drivers/staging/ti-st/st_kim.c new file +3
-0+static inline int kim_check_data_len (int len) +{ + register int room =
skb_tailroom(kim_gdata->rx_skb);drivers/staging/ti-st/st_kim.c new file +2
-0+ + ST_KIM_DBG("len %d room %d", len,room);
drivers/staging/ti-st/st_kim.c new file +3
-0+ +if (!len) { +
validate_firmware_response(kim_gdata->rx_skb);drivers/staging/ti-st/st_kim.c new file +2
-0+ }else if (len > room) { +/* Received packet's payload length is larger.
+ * We
can't accommodate it in created skb.drivers/staging/ti-st/st_kim.c new file +2
-0+*/ + ST_KIM_ERR("Datalength is too large len %d room %d", len,
drivers/staging/ti-st/st_kim.c new file +2
-0+ room); +
kfree_skb(kim_gdata->rx_skb);drivers/staging/ti-st/st_kim.c new file +2
-0+ }else { +/* Packet header has non-zero payload length and
+ * we have
enough space in created skb. Lets read
+ * payload
data */
+kim_gdata->rx_state=ST_BT_W4_DATA;
+kim_gdata->rx_count= len;drivers/staging/ti-st/st_kim.c new file +4
-0+return len; + } + +/* Change ST LL state to continue to process next
drivers/staging/ti-st/st_kim.c new file +2
-0+* packet */ + kim_gdata->rx_state =
ST_W4_PACKET_TYPE;drivers/staging/ti-st/st_kim.c new file +8
-0+ kim_gdata->rx_skb =NULL ; + kim_gdata->rx_count =0 ; + +return 0 ; +} + +/* receive function called during firmware download +* - firmware download responses on different UART drivers
+ * have been observed to come in bursts
of different
+ *tty_receiveand hence the logic
+ */drivers/staging/ti-st/st_kim.c new file +11
-0+void kim_int_recv (const unsigned char *data,long count) +{ + registerchar *ptr; +struct hci_event_hdr *eh; + registerint len =0 , type =0 ; + +ST_KIM_DBG ("%s" , __func__); +/* Decode received bytes here */ + ptr = (char *)data; +if (unlikely (ptr ==NULL )) { + ST_KIM_ERR("received null from TTY ");
drivers/staging/ti-st/st_kim.c new file +4
-0+return ; + } +while (count) { + if(
kim_gdata->rx_count) {
+
len =min_t(unsigned int, kim_gdata->rx_count, count); +memcpy(skb_put(kim_gdata->rx_skb, len), ptr, len); +kim_gdata->rx_count-= len;
+
count -= len;
+
ptr += len;drivers/staging/ti-st/st_kim.c new file +2
-0+ +if (
kim_gdata->rx_count)drivers/staging/ti-st/st_kim.c new file +3
-0+continue ; + +/* Check ST RX state machine , where are we? */
+
switch (kim_gdata->rx_state) {drivers/staging/ti-st/st_kim.c new file +2
-0+/* Waiting for complete packet ? */ +case
ST_BT_W4_DATA:drivers/staging/ti-st/st_kim.c new file +2
-0+ST_KIM_DBG ("Complete pkt received" ); +
validate_firmware_response(kim_gdata->rx_skb);
+kim_gdata->rx_state =
ST_W4_PACKET_TYPE;drivers/staging/ti-st/st_kim.c new file +3
-0+ kim_gdata->rx_skb =NULL ; +continue ; +/* Waiting for Bluetooth event header ? */
+
caseST_BT_W4_EVENT_HDR:
+
eh = (structhci_event_hdr
*)kim_gdata->drivers/staging/ti-st/st_kim.c new file +6
-0+ rx_skb->data; +ST_KIM_DBG ("Event header: evt 0x%2.2x" +"plen %d" , eh->evt, eh->plen); +kim_check_data_len (eh->plen); +continue ; +} /* end of switch */
drivers/staging/ti-st/st_kim.c new file +3
-0+ }/* end of if rx_state */ +switch (*ptr) { +/* Bluetooth event packet? */
drivers/staging/ti-st/st_kim.c new file +2
-0+case HCI_EVENT_PKT : +
ST_KIM_DBG("Event packet");
+kim_gdata->rx_state=ST_BT_W4_EVENT_HDR;
+kim_gdata->rx_count=HCI_EVENT_HDR_SIZE;
+
type =HCI_EVENT_PKT;
+
break;drivers/staging/ti-st/st_kim.c new file +2
-0+default : +
ST_KIM_DBG("unknown packet");
+
ptr++;
+
count--;
+
continue;drivers/staging/ti-st/st_kim.c new file +4
-0+ }/* end of switch *ptr */ + ptr++; + count--; + kim_gdata->rx_skb=
+bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC);
+ if
(!kim_gdata->rx_skb) {
+ST_KIM_ERR("can't allocate mem for new packet");
+kim_gdata->rx_state=ST_W4_PACKET_TYPE;
+kim_gdata->rx_count= 0;
+
return;
+ } /* not necessary
in this case */
+
bt_cb(kim_gdata->rx_skb)->pkt_type = type;drivers/staging/ti-st/st_kim.c new file +8
-0+ }/* end of while count */ +ST_KIM_DBG ("done %s" , __func__); +return ; +} + +static long read_local_version (char *bts_scr_name) +{ + unsigned short version = 0, chip = 0,
min_ver= 0,maj_ver= 0;
+ char read_ver_cmd[] = {0x01,0x01,0x10,0x00};drivers/staging/ti-st/st_kim.c new file +4
-0+ +ST_KIM_DBG ("%s" , __func__); + +
INIT_COMPLETION(kim_gdata->kim_rcvd);
+ if (4 !=st_int_write(read_ver_cmd, 4))
{
+ ST_KIM_ERR("kim:
couldn't write 4 bytes");
+ returnST_ERR_FAILURE;drivers/staging/ti-st/st_kim.c new file +4
-0+ } + + if (!wait_for_completion_timeout +(
&kim_gdata->kim_rcvd,msecs_to_jiffies(CMD_RESP_TIME))) {
+ ST_KIM_ERR(" waiting
for ver info- timed out ");
+ returnST_ERR_FAILURE;drivers/staging/ti-st/st_kim.c new file +4
-0+ } + + version = +MAKEWORD(kim_gdata->resp_buffer[13],
kim_gdata->resp_buffer[14]);
+ chip = (version &0x7C00) >>
10;drivers/staging/ti-st/st_kim.c new file +2
-0+ min_ver = (version &0x007F ); + maj_ver = (version &0x0380 )Quoted 1 line
Quoted 1 line
7;
drivers/staging/ti-st/st_kim.c new file +5
-0+ +if (version &0x8000 ) + maj_ver |=0x0008 ; + + sprintf(bts_scr_name,"TIInit_%d.%d.%d.bts", chip,
maj_ver,min_ver);drivers/staging/ti-st/st_kim.c new file +5
-0+ST_KIM_DBG ("%s" , bts_scr_name); +return ST_SUCCESS ; +} + +/* internal function which parses through the .bts firmware script file
+ * intreprets SEND, DELAY actions only as of now
+ */drivers/staging/ti-st/st_kim.c new file +6
-0+static long download_firmware (void ) +{ +long err =ST_SUCCESS ; +long len =0 ; + registerunsigned char *ptr =NULL ; + register unsigned char *action_ptr =NULL;
+ unsigned char bts_scr_name[30] = { 0
}; /* 30 char long bts scr name? */drivers/staging/ti-st/st_kim.c new file +4
-0+ +ST_KIM_VER ("%s" , __func__); + + err =
read_local_version(bts_scr_name);drivers/staging/ti-st/st_kim.c new file +2
-0+if (err !=ST_SUCCESS ) { + ST_KIM_ERR("kim:failed to read local ver");
drivers/staging/ti-st/st_kim.c new file +4
-0+return err; + } + err = +request_firmware(&kim_gdata->fw_entry,
bts_scr_name,drivers/staging/ti-st/st_kim.c new file +2
-0+ &kim_gdata->kim_pdev->dev); + if (unlikely((err != 0) ||(
kim_gdata->fw_entry->data== NULL) ||
+
(kim_gdata->fw_entry->size== 0)))
{
+ ST_KIM_ERR("request_firmwarefailed(errno %ld) for %s", err,drivers/staging/ti-st/st_kim.c new file +2
-0+ bts_scr_name); +return
ST_ERR_FAILURE;drivers/staging/ti-st/st_kim.c new file +2
-0+ } + ptr = (void*)kim_gdata->fw_entry->data;
drivers/staging/ti-st/st_kim.c new file +2
-0+ len = kim_gdata->fw_entry->size; +/* bts_header to remove out magic number and
drivers/staging/ti-st/st_kim.c new file +7
-0+* version +*/ + ptr +=sizeof (struct bts_header ); + len -=sizeof (struct bts_header ); + +while (len >0 && ptr) { + ST_KIM_VER(" actionsize %d, type %d ",
drivers/staging/ti-st/st_kim.c new file +4
-0+ ((struct bts_action *)ptr)->size, + ((struct bts_action *)ptr)->type); + + switch (((struct
bts_action*)ptr)->type) {
+ caseACTION_SEND_COMMAND: /* action send */
+action_ptr= &(((structbts_action*)ptr)->data[0]); +
if (unlikely
+(((struct hci_command *)action_ptr)->opcode==
drivers/staging/ti-st/st_kim.c new file +6
-0+ 0xFF36)) { +/* ignore remote change +* baud rate HCI VS command */ +ST_KIM_ERR + (" change remote baud\ + rate command infirmware");
drivers/staging/ti-st/st_kim.c new file +2
-0+break ; +}
drivers/staging/ti-st/st_kim.c new file +2
-0+ +
INIT_COMPLETION(kim_gdata->kim_rcvd);
+
err = st_int_write(((structbts_action_send*)
+action_ptr)->data,
drivers/staging/ti-st/st_kim.c new file +2
-0+ ((struct bts_action *)ptr)->size); +if (unlikely(err < 0)) {
+
release_firmware(kim_gdata->fw_entry);drivers/staging/ti-st/st_kim.c new file +2
-0+return ST_ERR_FAILURE ; +}
+
if (!wait_for_completion_timeoutdrivers/staging/ti-st/st_kim.c new file +2
-0+ (&kim_gdata->kim_rcvd, + msecs_to_jiffies(CMD_RESP_TIME))){
drivers/staging/ti-st/st_kim.c new file +2
-0+ST_KIM_ERR + (" response timeout duringfw download ");
drivers/staging/ti-st/st_kim.c new file +2
-0+/* timed out */ +
release_firmware(kim_gdata->fw_entry);drivers/staging/ti-st/st_kim.c new file +2
-0+return ST_ERR_FAILURE ; +}
+
break;
+ caseACTION_DELAY: /* sleep */
+ST_KIM_DBG("sleep command in scr");
+action_ptr= &(((structbts_action*)ptr)->data[0]); +mdelay(((struct bts_action_delay *)action_ptr)->msec); +
break;drivers/staging/ti-st/st_kim.c new file +3
-0+ } + len = + len -(
sizeof(struct bts_action)+drivers/staging/ti-st/st_kim.c new file +3
-0+ ((struct bts_action *)ptr)->size); + ptr = + ptr +
sizeof(struct bts_action)+
+
((structbts_action*)ptr)->size;drivers/staging/ti-st/st_kim.c new file +3
-0+ } +/* fw download complete */ +
release_firmware(kim_gdata->fw_entry);drivers/staging/ti-st/st_kim.c new file +8
-0+return ST_SUCCESS ; +} + +/**********************************************************************/ +/* functions called from ST core */ + +/* function to toggle the GPIO +* needs to know whether the GPIO is active high or active low
+ */
+voidst_kim_chip_toggle(enum proto_type type, enum kim_gpio_state state)drivers/staging/ti-st/st_kim.c new file +5
-0+{ +ST_KIM_DBG (" %s " , __func__); + +if (kim_gdata->gpios[type] ==-1 ) { + ST_KIM_DBG(" gpionot requested for protocol %s",
drivers/staging/ti-st/st_kim.c new file +10
-0+ protocol_names[type]); +return ; + } +switch (type) { +case ST_BT : +/*Do Nothing */ +break ; + +case ST_FM : + if (state ==
KIM_GPIO_ACTIVE)
+gpio_set_value(kim_gdata->gpios[ST_FM], GPIO_LOW);drivers/staging/ti-st/st_kim.c new file +2
-0+else +
gpio_set_value(kim_gdata->gpios[ST_FM], GPIO_HIGH);drivers/staging/ti-st/st_kim.c new file +4
-0+break ; + +case ST_GPS : + if (state ==
KIM_GPIO_ACTIVE)
+gpio_set_value(kim_gdata->gpios[ST_GPS], GPIO_HIGH);drivers/staging/ti-st/st_kim.c new file +2
-0+else +
gpio_set_value(kim_gdata->gpios[ST_GPS], GPIO_LOW);drivers/staging/ti-st/st_kim.c new file +11
-0+break ; + +case ST_MAX : +default : +break ; + } + +return ; +} + +/* called from ST Core, when REG_IN_PROGRESS (registration in progress)
+ * can be because of
+ * 1. response to read local version
+ * 2. during send/recv's of firmware download
+ */drivers/staging/ti-st/st_kim.c new file +5
-0+void st_kim_recv (const unsigned char *data,long count) +{ +ST_KIM_DBG (" %s " , __func__); +/* copy to local buffer */ + if (unlikely(data[4] == 0x01 &&data[5] ==
0x10&& data[0] ==0x04)) {
+ /* must be theread_ver_cmd*/
+memcpy(kim_gdata->resp_buffer, data, count);
+complete_all(&kim_gdata->kim_rcvd);drivers/staging/ti-st/st_kim.c new file +3
-0+return ; + }else { + kim_int_recv(data,count);
+ /* either completes
or times out */drivers/staging/ti-st/st_kim.c new file +10
-0+ } +return ; +} + +/* to signal completion of line discipline installation +* called from ST Core, upon tty_open +*/ +void st_kim_complete (void ) +{ +
complete(&kim_gdata->ldisc_installed);drivers/staging/ti-st/st_kim.c new file +13
-0+} + +/* called from ST Core upon 1st registration +*/ +long st_kim_start (void ) +{ +long err =ST_SUCCESS ; +long retry =POR_RETRY_COUNT ; +ST_KIM_DBG (" %s" , __func__); + + do { +#ifdef LEGACY_RFKILL_SUPPORT + /* TODO: this isonly because rfkill sub-system
+ * doesn't
send events to user-space if the state
+ * isn't
changeddrivers/staging/ti-st/st_kim.c new file +2
-0+*/ +
rfkill_set_sw_state(kim_gdata->rfkill[ST_BT], 1);drivers/staging/ti-st/st_kim.c new file +2
-0+#endif +/* Configure BT nShutdown to HIGH state */
+gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_LOW); +
mdelay(5); /* FIXME: a proper toggle */
+gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_HIGH);drivers/staging/ti-st/st_kim.c new file +2
-0+mdelay (100 ); +/* re-initialize the completion */
+INIT_COMPLETION(kim_gdata->ldisc_installed);drivers/staging/ti-st/st_kim.c new file +2
-0+#ifndef LEGACY_RFKILL_SUPPORT +/* send signal to UIM */
+ err =kill_pid(find_get_pid(kim_gdata->uim_pid), SIGUSR2, 0);drivers/staging/ti-st/st_kim.c new file +2
-0+if (err !=0 ) { +
ST_KIM_VER(" sending SIGUSR2 to uim failed %ld", err); +
err =ST_ERR_FAILURE;
+
continue;drivers/staging/ti-st/st_kim.c new file +3
-0+ } +#else +/* unblock and send event to UIM via
/dev/rfkill*/
+rfkill_set_sw_state(kim_gdata->rfkill[ST_BT], 0);drivers/staging/ti-st/st_kim.c new file +2
-0+#endif +/* wait for ldisc to be installed */
+ err =
wait_for_completion_timeout(&kim_gdata->ldisc_installed,drivers/staging/ti-st/st_kim.c new file +2
-0+ msecs_to_jiffies(LDISC_TIME)); +if (!err){ /* timeout */
+ST_KIM_ERR("line disc installation timed out ");
+
err =ST_ERR_FAILURE;
+
continue;drivers/staging/ti-st/st_kim.c new file +2
-0+ }else { +/* ldisc installed now */
+ST_KIM_DBG(" line discipline installed ");
+
err =download_firmware();
+
if (err !=ST_SUCCESS) {drivers/staging/ti-st/st_kim.c new file +3
-0+ST_KIM_ERR ("download firmware failed" ); +continue ; + }else { /* on success don't retry */
drivers/staging/ti-st/st_kim.c new file +2
-0+break ; +}
drivers/staging/ti-st/st_kim.c new file +12
-0+ } + }while (retry--); +return err; +} + +/* called from ST Core, on the last un-registration +*/ +long st_kim_stop (void ) +{ +long err =ST_SUCCESS ; + +
INIT_COMPLETION(kim_gdata->ldisc_installed);drivers/staging/ti-st/st_kim.c new file +3
-0+#ifndef LEGACY_RFKILL_SUPPORT +/* send signal to UIM */ + err =
kill_pid(find_get_pid(kim_gdata->uim_pid), SIGUSR2, 1);drivers/staging/ti-st/st_kim.c new file +2
-0+if (err !=0 ) { + ST_KIM_ERR("sendingSIGUSR2 to uim failed %ld", err);
+ returnST_ERR_FAILURE;drivers/staging/ti-st/st_kim.c new file +4
-0+ } +#else +/* set BT rfkill to be blocked */ + err =
rfkill_set_sw_state(kim_gdata->rfkill[ST_BT], 1);drivers/staging/ti-st/st_kim.c new file +3
-0+#endif + +/* wait for ldisc to be un-installed */
+ err =
wait_for_completion_timeout(&kim_gdata->ldisc_installed, +msecs_to_jiffies(LDISC_TIME));drivers/staging/ti-st/st_kim.c new file +2
-0+if (!err) {/* timeout */ + ST_KIM_ERR(" timedout waiting for ldisc to be un-installed");
+ returnST_ERR_FAILURE;drivers/staging/ti-st/st_kim.c new file +3
-0+ } + +/* By default configure BT nShutdown to LOW state */
+gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_LOW);drivers/staging/ti-st/st_kim.c new file +2
-0+mdelay (1 ); +
gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_HIGH);drivers/staging/ti-st/st_kim.c new file +2
-0+mdelay (1 ); +
gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_LOW);drivers/staging/ti-st/st_kim.c new file +9
-0+return err; +} + +/**********************************************************************/ +/* functions called from subsystems */ + +#ifndef LEGACY_RFKILL_SUPPORT +/* called when sysfs entry is written to */ +static ssize_t store_pid(struct device *dev, struct
device_attribute
+
*devattr, char *buf,size_t
count)drivers/staging/ti-st/st_kim.c new file +2
-0+{ + ST_KIM_DBG("%s: pid %s ", __func__,buf);
+ sscanf(buf, "%ld",&kim_gdata->uim_pid);
+ /* to be made use bykim_startto
signal SIGUSR2drivers/staging/ti-st/st_kim.c new file +6
-0+*/ +return strlen (buf); +} + +/* called when sysfs entry is read from */ +static ssize_t show_pid(struct device *dev, struct
device_attribute
+
*attr, char *buf)drivers/staging/ti-st/st_kim.c new file +2
-0+{ + sprintf(buf, "%ld",
kim_gdata->uim_pid);drivers/staging/ti-st/st_kim.c new file +5
-0+return strlen (buf); +} + +/* called when sysfs entry is read from */ +static ssize_t show_list(struct device *dev, struct
device_attributedrivers/staging/ti-st/st_kim.c new file +9
-0+ *attr, char *buf) +{ +kim_st_list_protocols (buf); +return strlen (buf); +} + +#else /* LEGACY_RFKILL_SUPPORT */ + +/* function called from rfkill subsystem, when someone from
+ * user space would write 0/1 on the sysfs entry
+ */sys/class/rfkill/rfkill0,1,3/state
+ */drivers/staging/ti-st/st_kim.c new file +3
-0+static int kim_toggle_radio (void *data,bool blocked) +{ + enum proto_type type = *((enum
proto_type*)data);
+ ST_KIM_DBG(" %s: %d ",__func__,
type);drivers/staging/ti-st/st_kim.c new file +9
-0+ +switch (type) { +case ST_BT : +/* do nothing */ +break ; +case ST_FM : +case ST_GPS : +if (blocked) +
st_kim_chip_toggle(type, KIM_GPIO_INACTIVE);drivers/staging/ti-st/st_kim.c new file +2
-0+else +
st_kim_chip_toggle(type, KIM_GPIO_ACTIVE);drivers/staging/ti-st/st_kim.c new file +3
-0+break ; +case ST_MAX : + ST_KIM_ERR(" wrongproto type ");
drivers/staging/ti-st/st_kim.c new file +10
-0+ break; + } +return ST_SUCCESS ; +} + +#endif /* LEGACY_RFKILL_SUPPORT */ + +/**********************************************************************/ +/* functions called from platform device driver subsystem +* need to have a relevant platform device entry in the platform's
+ * board-*.c file
+ */drivers/staging/ti-st/st_kim.c new file +6
-0+ +static int kim_probe (struct platform_device *pdev) +{ +long status; +long proto; + long *gpios =
pdev->dev.platform_data;drivers/staging/ti-st/st_kim.c new file +2
-0+ + for (proto = 0; proto < ST_MAX;proto++) {
+
kim_gdata->gpios[proto] = gpios[proto];
+ ST_KIM_VER(" %ld
gpio to be requested", gpios[proto]);drivers/staging/ti-st/st_kim.c new file +3
-0+ } + + for (proto = 0; (proto < ST_MAX)&& (gpios[proto] != -1); proto++) {
+ /* Claim the
Bluetooth/FM/GPIO
+ *
nShutdown gpio from the systemdrivers/staging/ti-st/st_kim.c new file +2
-0+*/ + status =
gpio_request(gpios[proto], "kim");
+ if
(unlikely(status)) {
+ST_KIM_ERR(" gpio %ld request failed ", gpios[proto]); +
proto -= 1;
+
while (proto >= 0) {drivers/staging/ti-st/st_kim.c new file +2
-0+if (gpios[proto] !=-1 ) +
gpio_free(gpios[proto]);
+
}
+
return status;drivers/staging/ti-st/st_kim.c new file +3
-0+ } + +/* Configure nShutdown GPIO as output=0 */
drivers/staging/ti-st/st_kim.c new file +2
-0+ status = +
gpio_direction_output(gpios[proto], 0);
+ if
(unlikely(status)) {
+
ST_KIM_ERR(" unable to configure gpio %ld",drivers/staging/ti-st/st_kim.c new file +2
-0+ gpios[proto]); +proto -= 1;
+
while (proto >= 0) {drivers/staging/ti-st/st_kim.c new file +2
-0+if (gpios[proto] !=-1 ) +
gpio_free(gpios[proto]);
+
}
+
return status;drivers/staging/ti-st/st_kim.c new file +4
-0+ } + } +#ifndef LEGACY_RFKILL_SUPPORT +/* pdev to contain BT, FM and GPS enable/N-Shutdown GPIOs
+ * executerequest_gpio, set
output directiondrivers/staging/ti-st/st_kim.c new file +2
-0+*/ + kim_gdata->kim_kobj =
kobject_create_and_add("uim", NULL);
+ /* create the sysfs entry for UIM to
put in pid */
+ if
(sysfs_create_group(kim_gdata->kim_kobj,&uim_attr_grp)) {
+ ST_KIM_ERR(" sysfs
entry creation failed");
+kobject_put(kim_gdata->kim_kobj);
+ /* free requested
GPIOs and fail probe */
+ for (proto =ST_BT;
proto <ST_MAX; proto++) {
+
if (gpios[proto] != -1)drivers/staging/ti-st/st_kim.c new file +7
-1+gpio_free (gpios[proto]); + } +return -1 ;/* fail insmod */ + } +ST_KIM_DBG (" sysfs entry created " ); +#endif +/* get reference of pdev for
request_firmwaredrivers/staging/ti-st/st_kim.c new file +3
-0+*/ + kim_gdata->kim_pdev = pdev; +
init_completion(&kim_gdata->kim_rcvd);
+init_completion(&kim_gdata->ldisc_installed);drivers/staging/ti-st/st_kim.c new file +2
-0+#ifdef LEGACY_RFKILL_SUPPORT + for (proto = 0; (proto < ST_MAX)&& (gpios[proto] != -1); proto++) {
+ /* TODO: should all
types berfkill_type_bt? */
+
kim_gdata->rf_protos[proto] = proto;
+
kim_gdata->rfkill[proto] = rfkill_alloc(protocol_names[proto],
+&pdev->dev,RFKILL_TYPE_BLUETOOTH,
+&kim_rfkill_ops, &kim_gdata->rf_protos[proto]);
+ if
(kim_gdata->rfkill[proto] == NULL) {
+
ST_KIM_ERR("cannot create rfkill entry for gpio %ld",drivers/staging/ti-st/st_kim.c new file +2
-0+ gpios[proto]); +continue;
drivers/staging/ti-st/st_kim.c new file +2
-0+ } +/* block upon creation */
+rfkill_init_sw_state(kim_gdata->rfkill[proto], 1);
+ status =rfkill_register(kim_gdata->rfkill[proto]);
+ if
(unlikely(status)) {
+
ST_KIM_ERR("rfkill registration failed for gpio %ld",drivers/staging/ti-st/st_kim.c new file +2
-0+ gpios[proto]); +
rfkill_unregister(kim_gdata->rfkill[proto]);
+
continue;drivers/staging/ti-st/st_kim.c new file +2
-0+ } + ST_KIM_DBG("rfkillentry created for %ld", gpios[proto]);
drivers/staging/ti-st/st_kim.c new file +10
-0+ } +#endif +return ST_SUCCESS ; +} + +static int kim_remove (struct platform_device *pdev) +{ +/* free the GPIOs requested +*/ + long *gpios =
pdev->dev.platform_data;drivers/staging/ti-st/st_kim.c new file +3
-0+long proto; + + for (proto = 0; (proto < ST_MAX)&& (gpios[proto] != -1); proto++) {
+ /* Claim the
Bluetooth/FM/GPIO
+ *
nShutdown gpio from the systemdrivers/staging/ti-st/st_kim.c new file +2
-0+*/ +
gpio_free(gpios[proto]);drivers/staging/ti-st/st_kim.c new file +2
-0+#ifdef LEGACY_RFKILL_SUPPORT +
rfkill_unregister(kim_gdata->rfkill[proto]);
+rfkill_destroy(kim_gdata->rfkill[proto]);
+
kim_gdata->rfkill[proto] = NULL;drivers/staging/ti-st/st_kim.c new file +6
-0+#endif + } +ST_KIM_DBG ("kim: GPIO Freed" ); +#ifndef LEGACY_RFKILL_SUPPORT +/* delete the sysfs entries */ +sysfs_remove_group(kim_gdata->kim_kobj,
&uim_attr_grp);drivers/staging/ti-st/st_kim.c new file +8
-0+kobject_put (kim_gdata->kim_kobj); +#endif + kim_gdata->kim_pdev =NULL ; +return ST_SUCCESS ; +} + +/**********************************************************************/ +/* entry point for ST KIM module, called in from ST Core */
drivers/staging/ti-st/st_kim.c new file +5
-0+ +long st_kim_init (void ) +{ +long ret =ST_SUCCESS ; + kim_gdata = kzalloc(sizeof(struct
kim_data_s),GFP_ATOMIC);drivers/staging/ti-st/st_kim.c new file +2
-0+if (!kim_gdata) { + ST_KIM_ERR("no memto allocate");
drivers/staging/ti-st/st_kim.c new file +3
-0+return -ENOMEM ; + } + ret =
platform_driver_register(&kim_platform_driver);drivers/staging/ti-st/st_kim.c new file +2
-0+if (ret !=0 ) { + ST_KIM_ERR("platformdrv registration failed");
+ returnST_ERR_FAILURE;drivers/staging/ti-st/st_kim.c new file +8
-0+ } +return ST_SUCCESS ; +} + +long st_kim_deinit (void ) +{ +/* the following returns void */ +
platform_driver_unregister(&kim_platform_driver);drivers/staging/ti-st/st_kim.c new file +4
-0+kfree (kim_gdata); + kim_gdata =NULL ; +return ST_SUCCESS ; +}drivers/staging/ti-st/st_kim.h new file +6
-0@@ -0,0 +1,152 @@ +/* +* Shared Transport Line discipline driver Core +* Init Manager Module header file +* Copyright (C) 2009 Texas Instruments +* +* This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License 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.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ *
+ */drivers/staging/ti-st/st_kim.h new file +16
-0+ +#ifndef ST_KIM_H +#define ST_KIM_H + +#include <linux/types.h> +#include "st.h" +#include "st_core.h" +#include "st_ll.h" +#include <linux/rfkill.h> + +/* time in msec to wait for +* line discipline to be installed +*/ +#define LDISC_TIME 500 +#define CMD_RESP_TIME 500 +#define MAKEWORD (a, b) ((unsigned short)(((unsignedchar)(a)) \
+ | ((unsigned short)((unsigned
char)(b))) << 8))drivers/staging/ti-st/st_kim.h new file +22
-0+ +#define GPIO_HIGH 1 +#define GPIO_LOW 0 + +/* the Power-On-Reset logic, requires to attempt +* to download firmware onto chip more than once +* since the self-test for chip takes a while +*/ +#define POR_RETRY_COUNT 5 +/* +* legacy rfkill support where-in 3 rfkill +* devices are created for the 3 gpios +* that ST has requested +*/ +#define LEGACY_RFKILL_SUPPORT +/* +* header file for ST provided by KIM +*/ +struct kim_data_s { +long uim_pid; +struct platform_device *kim_pdev; + struct completion kim_rcvd,
ldisc_installed;
+ /* MAX len of the .bts firmware script
name */drivers/staging/ti-st/st_kim.h new file +25
-0+char resp_buffer[30 ]; +const struct firmware *fw_entry; +long gpios[ST_MAX ]; +struct kobject *kim_kobj; +/* used by kim_int_recv to validate fw response */ +unsigned long rx_state; +unsigned long rx_count; +struct sk_buff *rx_skb; +#ifdef LEGACY_RFKILL_SUPPORT +struct rfkill *rfkill[ST_MAX ]; +enum proto_type rf_protos[ST_MAX ]; +#endif +}; + +long st_kim_init (void ); +long st_kim_deinit (void ); + +long st_kim_start (void ); +long st_kim_stop (void ); +/* +* called from st_tty_receive to authenticate fw_download +*/ +void st_kim_recv (const unsigned char *,long count); + +void st_kim_chip_toggle(enum proto_type, enum
kim_gpio_state);drivers/staging/ti-st/st_kim.h new file +17
-0+ +void st_kim_complete (void ); + +/* function called from ST KIM to ST Core, to +* list out the protocols registered +*/ +void kim_st_list_protocols (char *); + +/* +* BTS headers +*/ +#define ACTION_SEND_COMMAND 1 +#define ACTION_WAIT_EVENT 2 +#define ACTION_SERIAL 3 +#define ACTION_DELAY 4 +#define ACTION_RUN_SCRIPT 5 +#define ACTION_REMARKS 6
drivers/staging/ti-st/st_kim.h new file +51
-1+ +/* +* * BRF Firmware header +* */ +struct bts_header { +uint32_t magic; +uint32_t version; +uint8_t future[24 ]; +uint8_t actions[0 ]; +} __attribute__ ((packed)); + +/* +* * BRF Actions structure +* */ +struct bts_action { +uint16_t type; +uint16_t size; +uint8_t data[0 ]; +} __attribute__ ((packed)); + +struct bts_action_send { +uint8_t data[0 ]; +} __attribute__ ((packed)); + +struct bts_action_wait { +uint32_t msec; +uint32_t size; +uint8_t data[0 ]; +} __attribute__ ((packed)); + +struct bts_action_delay { +uint32_t msec; +} __attribute__ ((packed)); + +struct bts_action_serial { +uint32_t baud; +uint32_t flow_control; +} __attribute__ ((packed)); + +/* for identifying the change speed HCI VS +* command +*/ +struct hci_command { +uint8_t prefix; +uint16_t opcode; +uint8_t plen; +uint32_t speed; +} __attribute__ ((packed)); + + +#endif /* ST_KIM_H */ --
Quoted 2 lines
1.5.4.3
Greg,
Please consider the below patch, since there were few problems with the older one.
Small modification though, the rfkill_set_hw_state is used instead of the rfkill_set_sw_state.
From 9dbbd31e55e30f6aaea7f3ca830cf359cdd9f0f8 Mon Sep 17 00:00:00 2001
From: Pavan Savoy <[email protected]>
Date: Mon, 22 Mar 2010 13:19:39 -0400
Subject: [PATCH 3/8] drivers:staging: sources for Init manager module
Kernel Space Init-Manager works along with User-Mode Init Manager daemon running to maintain the UART state.
Communication between user-space daemon and this module can be
1. Via the pid written onto sysfs entry
2. Via the rfkill subsystem
It also is a platform driver with a relevant platform device in the board-*.c along with the list of BT/FM/GPS chip enable gpio configuration
--- drivers/staging/ti-st/st_kim.c | 747 ++++++++++++++++++++++++++++++++++++++++ drivers/staging/ti-st/st_kim.h | 152 ++++++++ 2 files changed, 899 insertions(+), 0 deletions(-) create mode 100644 drivers/staging/ti-st/st_kim.c create mode 100644 drivers/staging/ti-st/st_kim.h
drivers/staging/ti-st/st_kim.c new file +747 -0
@@ -0,0 +1,747 @@ +/* +* Shared Transport Line discipline driver Core +* Init Manager module responsible for GPIO control +* and firmware download +* Copyright (C) 2009 Texas Instruments +* +* This program is free software; you can redistribute it and/or modify +* it under the terms of the GNU General Public License 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. +* +* You should have received a copy of the GNU General Public License +* along with this program; if not, write to the Free Software +* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA +* +*/ + +#include <linux/platform_device.h> +#include <linux/jiffies.h> +#include <linux/firmware.h> +#include <linux/delay.h> +#include <linux/wait.h> +#include <linux/gpio.h> + +#include <linux/sched.h> + +#include "st_kim.h" +/* understand BT events for fw response */ +#include <net/bluetooth/bluetooth.h> +#include <net/bluetooth/hci_core.h> +#include <net/bluetooth/hci.h> + + +/* all debug macros go in here */ +#define ST_KIM_ERR(fmt, arg...) printk(KERN_ERR "(stk):"fmt"\n" , ## arg) +#if defined(DEBUG )/* limited debug messages */ +#define ST_KIM_DBG(fmt, arg...) printk(KERN_INFO "(stk):"fmt"\n" , ## arg) +#define ST_KIM_VER(fmt, arg...) +#elif defined(VERBOSE )/* very verbose */ +#define ST_KIM_DBG(fmt, arg...) printk(KERN_INFO "(stk):"fmt"\n" , ## arg) +#define ST_KIM_VER(fmt, arg...) printk(KERN_INFO "(stk):"fmt"\n" , ## arg) +#else /* error msgs only */ +#define ST_KIM_DBG(fmt, arg...) +#define ST_KIM_VER(fmt, arg...) +#endif + +static int kim_probe (struct platform_device *pdev); +static int kim_remove (struct platform_device *pdev); + +/* KIM platform device driver structure */ +static struct platform_driver kim_platform_driver = { + .probe = kim_probe, + .remove = kim_remove, +/* TODO: ST driver power management during suspend/resume ? +*/ +#if 0 + .suspend = kim_suspend, + .resume = kim_resume, +#endif + .driver = { + .name ="kim" , + .owner =THIS_MODULE , + }, +}; + +#ifndef LEGACY_RFKILL_SUPPORT +static ssize_t show_pid (struct device *dev,struct device_attribute + *attr,char *buf); +static ssize_t store_pid (struct device *dev,struct device_attribute + *devattr,char *buf,size_t count); +static ssize_t show_list (struct device *dev,struct device_attribute + *attr,char *buf); + +/* structures specific for sysfs entries */ +static struct kobj_attribute pid_attr = +__ATTR (pid,0644 , (void *)show_pid, (void *)store_pid); + +static struct kobj_attribute list_protocols = +__ATTR (protocols,0444 , (void *)show_list,NULL ); + +static struct attribute *uim_attrs[] = { + &pid_attr.attr, +/* add more debug sysfs entries */ + &list_protocols.attr, +NULL , +}; + +static struct attribute_group uim_attr_grp = { + .attrs = uim_attrs, +}; +#else +static int kim_toggle_radio (void *,bool ); +static const struct rfkill_ops kim_rfkill_ops = { + .set_block = kim_toggle_radio, +}; +#endif /* LEGACY_RFKILL_SUPPORT */ + +/* strings to be used for rfkill entries and by +* ST Core to be used for sysfs debug entry +*/ +#define PROTO_ENTRY (type, name) name +const unsigned char *protocol_names[] = { +PROTO_ENTRY (ST_BT ,"Bluetooth" ), +PROTO_ENTRY (ST_FM ,"FM" ), +PROTO_ENTRY (ST_GPS ,"GPS" ), +}; + +static struct kim_data_s *kim_gdata; + +/**********************************************************************/ +/* internal functions */ + +/* +* function to return whether the firmware response was proper +* in case of error don't complete so that waiting for proper +* response times out +*/ +void validate_firmware_response (struct sk_buff *skb) +{ +if (unlikely (skb->data[5 ] !=0 )) { +ST_KIM_ERR ("no proper response during fw download" ); +ST_KIM_ERR ("data6 %x" , skb->data[5 ]); +return ;/* keep waiting for the proper response */ + } +/* becos of all the script being downloaded */ +complete_all (&kim_gdata->kim_rcvd); +kfree_skb (skb); +} + +/* check for data len received inside kim_int_recv +* most often hit the last case to update state to waiting for data +*/ +static inline int kim_check_data_len (int len) +{ + registerint room =skb_tailroom (kim_gdata->rx_skb); + +ST_KIM_DBG ("len %d room %d" , len, room); + +if (!len) { +validate_firmware_response (kim_gdata->rx_skb); + }else if (len > room) { +/* Received packet's payload length is larger. +* We can't accommodate it in created skb. +*/ +ST_KIM_ERR ("Data length is too large len %d room %d" , len, + room); +kfree_skb (kim_gdata->rx_skb); + }else { +/* Packet header has non-zero payload length and +* we have enough space in created skb. Lets read +* payload data */ + kim_gdata->rx_state =ST_BT_W4_DATA ; + kim_gdata->rx_count = len; +return len; + } + +/* Change ST LL state to continue to process next +* packet */ + kim_gdata->rx_state =ST_W4_PACKET_TYPE ; + kim_gdata->rx_skb =NULL ; + kim_gdata->rx_count =0 ; + +return 0 ; +} + +/* receive function called during firmware download +* - firmware download responses on different UART drivers +* have been observed to come in bursts of different +* tty_receive and hence the logic +*/ +void kim_int_recv (const unsigned char *data,long count) +{ + registerchar *ptr; +struct hci_event_hdr *eh; + registerint len =0 , type =0 ; + +ST_KIM_DBG ("%s" , __func__); +/* Decode received bytes here */ + ptr = (char *)data; +if (unlikely (ptr ==NULL )) { +ST_KIM_ERR (" received null from TTY " ); +return ; + } +while (count) { +if (kim_gdata->rx_count) { + len = min_t(unsigned int, kim_gdata->rx_count, count); +memcpy (skb_put (kim_gdata->rx_skb, len), ptr, len); + kim_gdata->rx_count -= len; + count -= len; + ptr += len; + +if (kim_gdata->rx_count) +continue ; + +/* Check ST RX state machine , where are we? */ +switch (kim_gdata->rx_state) { +/* Waiting for complete packet ? */ +case ST_BT_W4_DATA : +ST_KIM_DBG ("Complete pkt received" ); +validate_firmware_response (kim_gdata->rx_skb); + kim_gdata->rx_state =ST_W4_PACKET_TYPE ; + kim_gdata->rx_skb =NULL ; +continue ; +/* Waiting for Bluetooth event header ? */ +case ST_BT_W4_EVENT_HDR : + eh = (struct hci_event_hdr *)kim_gdata-> + rx_skb->data; +ST_KIM_DBG ("Event header: evt 0x%2.2x" +"plen %d" , eh->evt, eh->plen); +kim_check_data_len (eh->plen); +continue ; + }/* end of switch */ + }/* end of if rx_state */ +switch (*ptr) { +/* Bluetooth event packet? */ +case HCI_EVENT_PKT : +ST_KIM_DBG ("Event packet" ); + kim_gdata->rx_state =ST_BT_W4_EVENT_HDR ; + kim_gdata->rx_count =HCI_EVENT_HDR_SIZE ; + type =HCI_EVENT_PKT ; +break ; +default : +ST_KIM_DBG ("unknown packet" ); + ptr++; + count--; +continue ; + }/* end of switch *ptr */ + ptr++; + count--; + kim_gdata->rx_skb = +bt_skb_alloc (HCI_MAX_FRAME_SIZE ,GFP_ATOMIC ); +if (!kim_gdata->rx_skb) { +ST_KIM_ERR ("can't allocate mem for new packet" ); + kim_gdata->rx_state =ST_W4_PACKET_TYPE ; + kim_gdata->rx_count =0 ; +return ; + }/* not necessary in this case */ +bt_cb (kim_gdata->rx_skb)->pkt_type = type; + }/* end of while count */ +ST_KIM_DBG ("done %s" , __func__); +return ; +} + +static long read_local_version (char *bts_scr_name) +{ +unsigned short version =0 , chip =0 , min_ver =0 , maj_ver =0 ; +char read_ver_cmd[] = {0x01 ,0x01 ,0x10 ,0x00 }; + +ST_KIM_DBG ("%s" , __func__); + +INIT_COMPLETION (kim_gdata->kim_rcvd); +if (4 !=st_int_write (read_ver_cmd,4 )) { +ST_KIM_ERR ("kim: couldn't write 4 bytes" ); +return ST_ERR_FAILURE ; + } + +if (!wait_for_completion_timeout + (&kim_gdata->kim_rcvd,msecs_to_jiffies (CMD_RESP_TIME ))) { +ST_KIM_ERR (" waiting for ver info- timed out " ); +return ST_ERR_FAILURE ; + } + + version = +MAKEWORD (kim_gdata->resp_buffer[13 ], kim_gdata->resp_buffer[14 ]); + chip = (version &0x7C00 ) >>10 ; + min_ver = (version &0x007F ); + maj_ver = (version &0x0380 ) >>7 ; + +if (version &0x8000 ) + maj_ver |=0x0008 ; + +sprintf (bts_scr_name,"TIInit_%d.%d.%d.bts" , chip, maj_ver, min_ver); +ST_KIM_DBG ("%s" , bts_scr_name); +return ST_SUCCESS ; +} + +/* internal function which parses through the .bts firmware script file +* intreprets SEND, DELAY actions only as of now +*/ +static long download_firmware (void ) +{ +long err =ST_SUCCESS ; +long len =0 ; + registerunsigned char *ptr =NULL ; + registerunsigned char *action_ptr =NULL ; +unsigned char bts_scr_name[30 ] = {0 };/* 30 char long bts scr name? */ + +ST_KIM_VER ("%s" , __func__); + + err =read_local_version (bts_scr_name); +if (err !=ST_SUCCESS ) { +ST_KIM_ERR ("kim: failed to read local ver" ); +return err; + } + err = +request_firmware (&kim_gdata->fw_entry, bts_scr_name, + &kim_gdata->kim_pdev->dev); +if (unlikely ((err !=0 ) || (kim_gdata->fw_entry->data ==NULL ) || + (kim_gdata->fw_entry->size ==0 ))) { +ST_KIM_ERR (" request_firmware failed(errno %ld) for %s" , err, + bts_scr_name); +return ST_ERR_FAILURE ; + } + ptr = (void *)kim_gdata->fw_entry->data; + len = kim_gdata->fw_entry->size; +/* bts_header to remove out magic number and +* version +*/ + ptr +=sizeof (struct bts_header ); + len -=sizeof (struct bts_header ); + +while (len >0 && ptr) { +ST_KIM_VER (" action size %d, type %d " , + ((struct bts_action *)ptr)->size, + ((struct bts_action *)ptr)->type); + +switch (((struct bts_action *)ptr)->type) { +case ACTION_SEND_COMMAND :/* action send */ + action_ptr = &(((struct bts_action *)ptr)->data[0 ]); +if (unlikely + (((struct hci_command *)action_ptr)->opcode == +0xFF36 )) { +/* ignore remote change +* baud rate HCI VS command */ +ST_KIM_ERR + (" change remote baud\ +rate command in firmware" ); +break ; + } + +INIT_COMPLETION (kim_gdata->kim_rcvd); + err =st_int_write (((struct bts_action_send *) + action_ptr)->data, + ((struct bts_action *)ptr)->size); +if (unlikely (err <0 )) { +release_firmware (kim_gdata->fw_entry); +return ST_ERR_FAILURE ; + } +if (!wait_for_completion_timeout + (&kim_gdata->kim_rcvd, +msecs_to_jiffies (CMD_RESP_TIME ))) { +ST_KIM_ERR + (" response timeout during fw download " ); +/* timed out */ +release_firmware (kim_gdata->fw_entry); +return ST_ERR_FAILURE ; + } +break ; +case ACTION_DELAY :/* sleep */ +ST_KIM_DBG ("sleep command in scr" ); + action_ptr = &(((struct bts_action *)ptr)->data[0 ]); +mdelay (((struct bts_action_delay *)action_ptr)->msec); +break ; + } + len = + len - (sizeof (struct bts_action ) + + ((struct bts_action *)ptr)->size); + ptr = + ptr +sizeof (struct bts_action ) + + ((struct bts_action *)ptr)->size; + } +/* fw download complete */ +release_firmware (kim_gdata->fw_entry); +return ST_SUCCESS ; +} + +/**********************************************************************/ +/* functions called from ST core */ + +/* function to toggle the GPIO +* needs to know whether the GPIO is active high or active low +*/ +void st_kim_chip_toggle (enum proto_type type,enum kim_gpio_state state) +{ +ST_KIM_DBG (" %s " , __func__); + +if (kim_gdata->gpios[type] ==-1 ) { +ST_KIM_DBG (" gpio not requested for protocol %s" , + protocol_names[type]); +return ; + } +switch (type) { +case ST_BT : +/*Do Nothing */ +break ; + +case ST_FM : +if (state ==KIM_GPIO_ACTIVE ) +gpio_set_value (kim_gdata->gpios[ST_FM ],GPIO_LOW ); +else +gpio_set_value (kim_gdata->gpios[ST_FM ],GPIO_HIGH ); +break ; + +case ST_GPS : +if (state ==KIM_GPIO_ACTIVE ) +gpio_set_value (kim_gdata->gpios[ST_GPS ],GPIO_HIGH ); +else +gpio_set_value (kim_gdata->gpios[ST_GPS ],GPIO_LOW ); +break ; + +case ST_MAX : +default : +break ; + } + +return ; +} + +/* called from ST Core, when REG_IN_PROGRESS (registration in progress) +* can be because of +* 1. response to read local version +* 2. during send/recv's of firmware download +*/ +void st_kim_recv (const unsigned char *data,long count) +{ +ST_KIM_DBG (" %s " , __func__); +/* copy to local buffer */ +if (unlikely (data[4 ] ==0x01 && data[5 ] ==0x10 && data[0 ] ==0x04 )) { +/* must be the read_ver_cmd */ +memcpy (kim_gdata->resp_buffer, data, count); +complete_all (&kim_gdata->kim_rcvd); +return ; + }else { +kim_int_recv (data, count); +/* either completes or times out */ + } +return ; +} + +/* to signal completion of line discipline installation +* called from ST Core, upon tty_open +*/ +void st_kim_complete (void ) +{ +complete (&kim_gdata->ldisc_installed); +} + +/* called from ST Core upon 1st registration +*/ +long st_kim_start (void ) +{ +long err =ST_SUCCESS ; +long retry =POR_RETRY_COUNT ; +ST_KIM_DBG (" %s" , __func__); + +do { +#ifdef LEGACY_RFKILL_SUPPORT +/* TODO: this is only because rfkill sub-system +* doesn't send events to user-space if the state +* isn't changed +*/ +rfkill_set_hw_state (kim_gdata->rfkill[ST_BT ],1 ); +#endif +/* Configure BT nShutdown to HIGH state */ +gpio_set_value (kim_gdata->gpios[ST_BT ],GPIO_LOW ); +mdelay (5 );/* FIXME: a proper toggle */ +gpio_set_value (kim_gdata->gpios[ST_BT ],GPIO_HIGH ); +mdelay (100 ); +/* re-initialize the completion */ +INIT_COMPLETION (kim_gdata->ldisc_installed); +#ifndef LEGACY_RFKILL_SUPPORT +/* send signal to UIM */ + err =kill_pid (find_get_pid (kim_gdata->uim_pid),SIGUSR2 ,0 ); +if (err !=0 ) { +ST_KIM_VER (" sending SIGUSR2 to uim failed %ld" , err); + err =ST_ERR_FAILURE ; +continue ; + } +#else +/* unblock and send event to UIM via /dev/rfkill */ +rfkill_set_hw_state (kim_gdata->rfkill[ST_BT ],0 ); +#endif +/* wait for ldisc to be installed */ + err =wait_for_completion_timeout (&kim_gdata->ldisc_installed, +msecs_to_jiffies (LDISC_TIME )); +if (!err) {/* timeout */ +ST_KIM_ERR ("line disc installation timed out " ); + err =ST_ERR_FAILURE ; +continue ; + }else { +/* ldisc installed now */ +ST_KIM_DBG (" line discipline installed " ); + err =download_firmware (); +if (err !=ST_SUCCESS ) { +ST_KIM_ERR ("download firmware failed" ); +continue ; + }else {/* on success don't retry */ +break ; + } + } + }while (retry--); +return err; +} + +/* called from ST Core, on the last un-registration +*/ +long st_kim_stop (void ) +{ +long err =ST_SUCCESS ; + +INIT_COMPLETION (kim_gdata->ldisc_installed); +#ifndef LEGACY_RFKILL_SUPPORT +/* send signal to UIM */ + err =kill_pid (find_get_pid (kim_gdata->uim_pid),SIGUSR2 ,1 ); +if (err !=0 ) { +ST_KIM_ERR ("sending SIGUSR2 to uim failed %ld" , err); +return ST_ERR_FAILURE ; + } +#else +/* set BT rfkill to be blocked */ + err =rfkill_set_hw_state (kim_gdata->rfkill[ST_BT ],1 ); +#endif + +/* wait for ldisc to be un-installed */ + err =wait_for_completion_timeout (&kim_gdata->ldisc_installed, +msecs_to_jiffies (LDISC_TIME )); +if (!err) {/* timeout */ +ST_KIM_ERR (" timed out waiting for ldisc to be un-installed" ); +return ST_ERR_FAILURE ; + } + +/* By default configure BT nShutdown to LOW state */ +gpio_set_value (kim_gdata->gpios[ST_BT ],GPIO_LOW ); +mdelay (1 ); +gpio_set_value (kim_gdata->gpios[ST_BT ],GPIO_HIGH ); +mdelay (1 ); +gpio_set_value (kim_gdata->gpios[ST_BT ],GPIO_LOW ); +return err; +} + +/**********************************************************************/ +/* functions called from subsystems */ + +#ifndef LEGACY_RFKILL_SUPPORT +/* called when sysfs entry is written to */ +static ssize_t store_pid (struct device *dev,struct device_attribute + *devattr,char *buf,size_t count) +{ +ST_KIM_DBG ("%s: pid %s " , __func__, buf); +sscanf (buf,"%ld" , &kim_gdata->uim_pid); +/* to be made use by kim_start to signal SIGUSR2 +*/ +return strlen (buf); +} + +/* called when sysfs entry is read from */ +static ssize_t show_pid (struct device *dev,struct device_attribute + *attr,char *buf) +{ +sprintf (buf,"%ld" , kim_gdata->uim_pid); +return strlen (buf); +} + +/* called when sysfs entry is read from */ +static ssize_t show_list (struct device *dev,struct device_attribute + *attr,char *buf) +{ +kim_st_list_protocols (buf); +return strlen (buf); +} + +#else /* LEGACY_RFKILL_SUPPORT */ + +/* function called from rfkill subsystem, when someone from +* user space would write 0/1 on the sysfs entry +* /sys/class/rfkill/rfkill0,1,3/state +*/ +static int kim_toggle_radio (void *data,bool blocked) +{ +enum proto_type type = *((enum proto_type *)data); +ST_KIM_DBG (" %s: %d " , __func__, type); + +switch (type) { +case ST_BT : +/* do nothing */ +break ; +case ST_FM : +case ST_GPS : +if (blocked) +st_kim_chip_toggle (type,KIM_GPIO_INACTIVE ); +else +st_kim_chip_toggle (type,KIM_GPIO_ACTIVE ); +break ; +case ST_MAX : +ST_KIM_ERR (" wrong proto type " ); +break ; + } +return ST_SUCCESS ; +} + +#endif /* LEGACY_RFKILL_SUPPORT */ + +/**********************************************************************/ +/* functions called from platform device driver subsystem +* need to have a relevant platform device entry in the platform's +* board-*.c file +*/ + +static int kim_probe (struct platform_device *pdev) +{ +long status; +long proto; +long *gpios = pdev->dev.platform_data; + +for (proto =0 ; proto <ST_MAX ; proto++) { + kim_gdata->gpios[proto] = gpios[proto]; +ST_KIM_VER (" %ld gpio to be requested" , gpios[proto]); + } + +for (proto =0 ; (proto <ST_MAX ) && (gpios[proto] !=-1 ); proto++) { +/* Claim the Bluetooth/FM/GPIO +* nShutdown gpio from the system +*/ + status =gpio_request (gpios[proto],"kim" ); +if (unlikely (status)) { +ST_KIM_ERR (" gpio %ld request failed " , gpios[proto]); + proto -=1 ; +while (proto >=0 ) { +if (gpios[proto] !=-1 ) +gpio_free (gpios[proto]); + } +return status; + } + +/* Configure nShutdown GPIO as output=0 */ + status = +gpio_direction_output (gpios[proto],0 ); +if (unlikely (status)) { +ST_KIM_ERR (" unable to configure gpio %ld" , + gpios[proto]); + proto -=1 ; +while (proto >=0 ) { +if (gpios[proto] !=-1 ) +gpio_free (gpios[proto]); + } +return status; + } + } +#ifndef LEGACY_RFKILL_SUPPORT +/* pdev to contain BT, FM and GPS enable/N-Shutdown GPIOs +* execute request_gpio, set output direction +*/ + kim_gdata->kim_kobj =kobject_create_and_add ("uim" ,NULL ); +/* create the sysfs entry for UIM to put in pid */ +if (sysfs_create_group (kim_gdata->kim_kobj, &uim_attr_grp)) { +ST_KIM_ERR (" sysfs entry creation failed" ); +kobject_put (kim_gdata->kim_kobj); +/* free requested GPIOs and fail probe */ +for (proto =ST_BT ; proto <ST_MAX ; proto++) { +if (gpios[proto] !=-1 ) +gpio_free (gpios[proto]); + } +return -1 ;/* fail insmod */ + } +ST_KIM_DBG (" sysfs entry created " ); +#endif +/* get reference of pdev for request_firmware +*/ + kim_gdata->kim_pdev = pdev; +init_completion (&kim_gdata->kim_rcvd); +init_completion (&kim_gdata->ldisc_installed); +#ifdef LEGACY_RFKILL_SUPPORT +for (proto =0 ; (proto <ST_MAX ) && (gpios[proto] !=-1 ); proto++) { +/* TODO: should all types be rfkill_type_bt ? */ + kim_gdata->rf_protos[proto] = proto; + kim_gdata->rfkill[proto] =rfkill_alloc (protocol_names[proto], + &pdev->dev,RFKILL_TYPE_BLUETOOTH , + &kim_rfkill_ops, &kim_gdata->rf_protos[proto]); +if (kim_gdata->rfkill[proto] ==NULL ) { +ST_KIM_ERR ("cannot create rfkill entry for gpio %ld" , + gpios[proto]); +continue ; + } +/* block upon creation */ +rfkill_init_sw_state (kim_gdata->rfkill[proto],1 ); + status =rfkill_register (kim_gdata->rfkill[proto]); +if (unlikely (status)) { +ST_KIM_ERR ("rfkill registration failed for gpio %ld" , + gpios[proto]); +rfkill_unregister (kim_gdata->rfkill[proto]); +continue ; + } +ST_KIM_DBG ("rfkill entry created for %ld" , gpios[proto]); + } +#endif +return ST_SUCCESS ; +} + +static int kim_remove (struct platform_device *pdev) +{ +/* free the GPIOs requested +*/ +long *gpios = pdev->dev.platform_data; +long proto; + +for (proto =0 ; (proto <ST_MAX ) && (gpios[proto] !=-1 ); proto++) { +/* Claim the Bluetooth/FM/GPIO +* nShutdown gpio from the system +*/ +gpio_free (gpios[proto]); +#ifdef LEGACY_RFKILL_SUPPORT +rfkill_unregister (kim_gdata->rfkill[proto]); +rfkill_destroy (kim_gdata->rfkill[proto]); + kim_gdata->rfkill[proto] =NULL ; +#endif + } +ST_KIM_DBG ("kim: GPIO Freed" ); +#ifndef LEGACY_RFKILL_SUPPORT +/* delete the sysfs entries */ +sysfs_remove_group (kim_gdata->kim_kobj, &uim_attr_grp); +kobject_put (kim_gdata->kim_kobj); +#endif + kim_gdata->kim_pdev =NULL ; +return ST_SUCCESS ; +} + +/**********************************************************************/ +/* entry point for ST KIM module, called in from ST Core */ + +long st_kim_init (void ) +{ +long ret =ST_SUCCESS ; + kim_gdata =kzalloc (sizeof (struct kim_data_s ),GFP_ATOMIC ); +if (!kim_gdata) { +ST_KIM_ERR ("no mem to allocate" ); +return -ENOMEM ; + } + ret =platform_driver_register (&kim_platform_driver); +if (ret !=0 ) { +ST_KIM_ERR ("platform drv registration failed" ); +return ST_ERR_FAILURE ; + } +return ST_SUCCESS ; +} + +long st_kim_deinit (void ) +{ +/* the following returns void */ +platform_driver_unregister (&kim_platform_driver); +kfree (kim_gdata); + kim_gdata =NULL ; +return ST_SUCCESS ; +}
drivers/staging/ti-st/st_kim.h new file +152 -0
152 lines not on this page · raw message
Signature · 1 line
1.5.4.3