Merge branch 'drm-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/airlied...
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / ti-st / st_kim.c
CommitLineData
d0088ce1
PS
1/*
2 * Shared Transport Line discipline driver Core
3 * Init Manager module responsible for GPIO control
4 * and firmware download
5 * Copyright (C) 2009 Texas Instruments
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19 *
20 */
21
22#define pr_fmt(fmt) "(stk) :" fmt
23#include <linux/platform_device.h>
24#include <linux/jiffies.h>
25#include <linux/firmware.h>
26#include <linux/delay.h>
27#include <linux/wait.h>
28#include <linux/gpio.h>
29
30#include <linux/sched.h>
31
32#include "st_kim.h"
33/* understand BT events for fw response */
34#include <net/bluetooth/bluetooth.h>
35#include <net/bluetooth/hci_core.h>
36#include <net/bluetooth/hci.h>
37
38
39static int kim_probe(struct platform_device *pdev);
40static int kim_remove(struct platform_device *pdev);
41
42/* KIM platform device driver structure */
43static struct platform_driver kim_platform_driver = {
44 .probe = kim_probe,
45 .remove = kim_remove,
46 /* TODO: ST driver power management during suspend/resume ?
47 */
48#if 0
49 .suspend = kim_suspend,
50 .resume = kim_resume,
51#endif
52 .driver = {
53 .name = "kim",
54 .owner = THIS_MODULE,
55 },
56};
57
58#ifndef LEGACY_RFKILL_SUPPORT
59static ssize_t show_pid(struct device *dev, struct device_attribute
60 *attr, char *buf);
61static ssize_t store_pid(struct device *dev, struct device_attribute
62 *devattr, char *buf, size_t count);
63static ssize_t show_list(struct device *dev, struct device_attribute
64 *attr, char *buf);
65
66/* structures specific for sysfs entries */
67static struct kobj_attribute pid_attr =
68__ATTR(pid, 0644, (void *)show_pid, (void *)store_pid);
69
70static struct kobj_attribute list_protocols =
71__ATTR(protocols, 0444, (void *)show_list, NULL);
72
73static struct attribute *uim_attrs[] = {
74 &pid_attr.attr,
75 /* add more debug sysfs entries */
76 &list_protocols.attr,
77 NULL,
78};
79
80static struct attribute_group uim_attr_grp = {
81 .attrs = uim_attrs,
82};
83#else
84static int kim_toggle_radio(void*, bool);
85static const struct rfkill_ops kim_rfkill_ops = {
86 .set_block = kim_toggle_radio,
87};
88#endif /* LEGACY_RFKILL_SUPPORT */
89
90/* strings to be used for rfkill entries and by
91 * ST Core to be used for sysfs debug entry
92 */
93#define PROTO_ENTRY(type, name) name
94const unsigned char *protocol_names[] = {
95 PROTO_ENTRY(ST_BT, "Bluetooth"),
96 PROTO_ENTRY(ST_FM, "FM"),
97 PROTO_ENTRY(ST_GPS, "GPS"),
98};
99
100struct kim_data_s *kim_gdata;
101
102/**********************************************************************/
103/* internal functions */
104
105/*
106 * function to return whether the firmware response was proper
107 * in case of error don't complete so that waiting for proper
108 * response times out
109 */
110void validate_firmware_response(struct sk_buff *skb)
111{
112 if (unlikely(skb->data[5] != 0)) {
113 pr_err("no proper response during fw download");
114 pr_err("data6 %x", skb->data[5]);
115 return; /* keep waiting for the proper response */
116 }
117 /* becos of all the script being downloaded */
118 complete_all(&kim_gdata->kim_rcvd);
119 kfree_skb(skb);
120}
121
122/* check for data len received inside kim_int_recv
123 * most often hit the last case to update state to waiting for data
124 */
125static inline int kim_check_data_len(int len)
126{
127 register int room = skb_tailroom(kim_gdata->rx_skb);
128
129 pr_info("len %d room %d", len, room);
130
131 if (!len) {
132 validate_firmware_response(kim_gdata->rx_skb);
133 } else if (len > room) {
134 /* Received packet's payload length is larger.
135 * We can't accommodate it in created skb.
136 */
137 pr_err("Data length is too large len %d room %d", len,
138 room);
139 kfree_skb(kim_gdata->rx_skb);
140 } else {
141 /* Packet header has non-zero payload length and
142 * we have enough space in created skb. Lets read
143 * payload data */
144 kim_gdata->rx_state = ST_BT_W4_DATA;
145 kim_gdata->rx_count = len;
146 return len;
147 }
148
149 /* Change ST LL state to continue to process next
150 * packet */
151 kim_gdata->rx_state = ST_W4_PACKET_TYPE;
152 kim_gdata->rx_skb = NULL;
153 kim_gdata->rx_count = 0;
154
155 return 0;
156}
157
158/* receive function called during firmware download
159 * - firmware download responses on different UART drivers
160 * have been observed to come in bursts of different
161 * tty_receive and hence the logic
162 */
163void kim_int_recv(const unsigned char *data, long count)
164{
165 register char *ptr;
166 struct hci_event_hdr *eh;
167 register int len = 0, type = 0;
168
169 pr_info("%s", __func__);
170 /* Decode received bytes here */
171 ptr = (char *)data;
172 if (unlikely(ptr == NULL)) {
173 pr_err(" received null from TTY ");
174 return;
175 }
176 while (count) {
177 if (kim_gdata->rx_count) {
178 len = min_t(unsigned int, kim_gdata->rx_count, count);
179 memcpy(skb_put(kim_gdata->rx_skb, len), ptr, len);
180 kim_gdata->rx_count -= len;
181 count -= len;
182 ptr += len;
183
184 if (kim_gdata->rx_count)
185 continue;
186
187 /* Check ST RX state machine , where are we? */
188 switch (kim_gdata->rx_state) {
189 /* Waiting for complete packet ? */
190 case ST_BT_W4_DATA:
191 pr_info("Complete pkt received");
192 validate_firmware_response(kim_gdata->rx_skb);
193 kim_gdata->rx_state = ST_W4_PACKET_TYPE;
194 kim_gdata->rx_skb = NULL;
195 continue;
196 /* Waiting for Bluetooth event header ? */
197 case ST_BT_W4_EVENT_HDR:
198 eh = (struct hci_event_hdr *)kim_gdata->
199 rx_skb->data;
200 pr_info("Event header: evt 0x%2.2x"
201 "plen %d", eh->evt, eh->plen);
202 kim_check_data_len(eh->plen);
203 continue;
204 } /* end of switch */
205 } /* end of if rx_state */
206 switch (*ptr) {
207 /* Bluetooth event packet? */
208 case HCI_EVENT_PKT:
209 pr_info("Event packet");
210 kim_gdata->rx_state = ST_BT_W4_EVENT_HDR;
211 kim_gdata->rx_count = HCI_EVENT_HDR_SIZE;
212 type = HCI_EVENT_PKT;
213 break;
214 default:
215 pr_info("unknown packet");
216 ptr++;
217 count--;
218 continue;
219 } /* end of switch *ptr */
220 ptr++;
221 count--;
222 kim_gdata->rx_skb =
223 bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC);
224 if (!kim_gdata->rx_skb) {
225 pr_err("can't allocate mem for new packet");
226 kim_gdata->rx_state = ST_W4_PACKET_TYPE;
227 kim_gdata->rx_count = 0;
228 return;
229 } /* not necessary in this case */
230 bt_cb(kim_gdata->rx_skb)->pkt_type = type;
231 } /* end of while count */
232 pr_info("done %s", __func__);
233 return;
234}
235
236static long read_local_version(char *bts_scr_name)
237{
238 unsigned short version = 0, chip = 0, min_ver = 0, maj_ver = 0;
239 char read_ver_cmd[] = { 0x01, 0x01, 0x10, 0x00 };
240
241 pr_info("%s", __func__);
242
243 INIT_COMPLETION(kim_gdata->kim_rcvd);
244 if (4 != st_int_write(kim_gdata->core_data, read_ver_cmd, 4)) {
245 pr_err("kim: couldn't write 4 bytes");
246 return ST_ERR_FAILURE;
247 }
248
249 if (!wait_for_completion_timeout
250 (&kim_gdata->kim_rcvd, msecs_to_jiffies(CMD_RESP_TIME))) {
251 pr_err(" waiting for ver info- timed out ");
252 return ST_ERR_FAILURE;
253 }
254
255 version =
256 MAKEWORD(kim_gdata->resp_buffer[13], kim_gdata->resp_buffer[14]);
257 chip = (version & 0x7C00) >> 10;
258 min_ver = (version & 0x007F);
259 maj_ver = (version & 0x0380) >> 7;
260
261 if (version & 0x8000)
262 maj_ver |= 0x0008;
263
264 sprintf(bts_scr_name, "TIInit_%d.%d.%d.bts", chip, maj_ver, min_ver);
265 pr_info("%s", bts_scr_name);
266 return ST_SUCCESS;
267}
268
269/* internal function which parses through the .bts firmware script file
270 * intreprets SEND, DELAY actions only as of now
271 */
272static long download_firmware(void)
273{
274 long err = ST_SUCCESS;
275 long len = 0;
276 register unsigned char *ptr = NULL;
277 register unsigned char *action_ptr = NULL;
278 unsigned char bts_scr_name[30] = { 0 }; /* 30 char long bts scr name? */
279
280 pr_info("%s", __func__);
281
282 err = read_local_version(bts_scr_name);
283 if (err != ST_SUCCESS) {
284 pr_err("kim: failed to read local ver");
285 return err;
286 }
287 err =
288 request_firmware(&kim_gdata->fw_entry, bts_scr_name,
289 &kim_gdata->kim_pdev->dev);
290 if (unlikely((err != 0) || (kim_gdata->fw_entry->data == NULL) ||
291 (kim_gdata->fw_entry->size == 0))) {
292 pr_err(" request_firmware failed(errno %ld) for %s", err,
293 bts_scr_name);
294 return ST_ERR_FAILURE;
295 }
296 ptr = (void *)kim_gdata->fw_entry->data;
297 len = kim_gdata->fw_entry->size;
298 /* bts_header to remove out magic number and
299 * version
300 */
301 ptr += sizeof(struct bts_header);
302 len -= sizeof(struct bts_header);
303
304 while (len > 0 && ptr) {
305 pr_info(" action size %d, type %d ",
306 ((struct bts_action *)ptr)->size,
307 ((struct bts_action *)ptr)->type);
308
309 switch (((struct bts_action *)ptr)->type) {
310 case ACTION_SEND_COMMAND: /* action send */
311 action_ptr = &(((struct bts_action *)ptr)->data[0]);
312 if (unlikely
313 (((struct hci_command *)action_ptr)->opcode ==
314 0xFF36)) {
315 /* ignore remote change
316 * baud rate HCI VS command */
317 pr_err
318 (" change remote baud\
319 rate command in firmware");
320 break;
321 }
322
323 INIT_COMPLETION(kim_gdata->kim_rcvd);
324 err = st_int_write(kim_gdata->core_data,
325 ((struct bts_action_send *)action_ptr)->data,
326 ((struct bts_action *)ptr)->size);
327 if (unlikely(err < 0)) {
328 release_firmware(kim_gdata->fw_entry);
329 return ST_ERR_FAILURE;
330 }
331 if (!wait_for_completion_timeout
332 (&kim_gdata->kim_rcvd,
333 msecs_to_jiffies(CMD_RESP_TIME))) {
334 pr_err
335 (" response timeout during fw download ");
336 /* timed out */
337 release_firmware(kim_gdata->fw_entry);
338 return ST_ERR_FAILURE;
339 }
340 break;
341 case ACTION_DELAY: /* sleep */
342 pr_info("sleep command in scr");
343 action_ptr = &(((struct bts_action *)ptr)->data[0]);
344 mdelay(((struct bts_action_delay *)action_ptr)->msec);
345 break;
346 }
347 len =
348 len - (sizeof(struct bts_action) +
349 ((struct bts_action *)ptr)->size);
350 ptr =
351 ptr + sizeof(struct bts_action) +
352 ((struct bts_action *)ptr)->size;
353 }
354 /* fw download complete */
355 release_firmware(kim_gdata->fw_entry);
356 return ST_SUCCESS;
357}
358
359/**********************************************************************/
360/* functions called from ST core */
361
362/* function to toggle the GPIO
363 * needs to know whether the GPIO is active high or active low
364 */
365void st_kim_chip_toggle(enum proto_type type, enum kim_gpio_state state)
366{
367 pr_info(" %s ", __func__);
368
369 if (kim_gdata->gpios[type] == -1) {
370 pr_info(" gpio not requested for protocol %s",
371 protocol_names[type]);
372 return;
373 }
374 switch (type) {
375 case ST_BT:
376 /*Do Nothing */
377 break;
378
379 case ST_FM:
380 if (state == KIM_GPIO_ACTIVE)
381 gpio_set_value(kim_gdata->gpios[ST_FM], GPIO_LOW);
382 else
383 gpio_set_value(kim_gdata->gpios[ST_FM], GPIO_HIGH);
384 break;
385
386 case ST_GPS:
387 if (state == KIM_GPIO_ACTIVE)
388 gpio_set_value(kim_gdata->gpios[ST_GPS], GPIO_HIGH);
389 else
390 gpio_set_value(kim_gdata->gpios[ST_GPS], GPIO_LOW);
391 break;
392
393 case ST_MAX:
394 default:
395 break;
396 }
397
398 return;
399}
400
401/* called from ST Core, when REG_IN_PROGRESS (registration in progress)
402 * can be because of
403 * 1. response to read local version
404 * 2. during send/recv's of firmware download
405 */
406void st_kim_recv(void *disc_data, const unsigned char *data, long count)
407{
408 pr_info(" %s ", __func__);
409 /* copy to local buffer */
410 if (unlikely(data[4] == 0x01 && data[5] == 0x10 && data[0] == 0x04)) {
411 /* must be the read_ver_cmd */
412 memcpy(kim_gdata->resp_buffer, data, count);
413 complete_all(&kim_gdata->kim_rcvd);
414 return;
415 } else {
416 kim_int_recv(data, count);
417 /* either completes or times out */
418 }
419 return;
420}
421
422/* to signal completion of line discipline installation
423 * called from ST Core, upon tty_open
424 */
425void st_kim_complete(void)
426{
427 complete(&kim_gdata->ldisc_installed);
428}
429
430/* called from ST Core upon 1st registration
431*/
432long st_kim_start(void)
433{
434 long err = ST_SUCCESS;
435 long retry = POR_RETRY_COUNT;
436 pr_info(" %s", __func__);
437
438 do {
439#ifdef LEGACY_RFKILL_SUPPORT
440 /* TODO: this is only because rfkill sub-system
441 * doesn't send events to user-space if the state
442 * isn't changed
443 */
444 rfkill_set_hw_state(kim_gdata->rfkill[ST_BT], 1);
445#endif
446 /* Configure BT nShutdown to HIGH state */
447 gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_LOW);
448 mdelay(5); /* FIXME: a proper toggle */
449 gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_HIGH);
450 mdelay(100);
451 /* re-initialize the completion */
452 INIT_COMPLETION(kim_gdata->ldisc_installed);
453#ifndef LEGACY_RFKILL_SUPPORT
454 /* send signal to UIM */
455 err = kill_pid(find_get_pid(kim_gdata->uim_pid), SIGUSR2, 0);
456 if (err != 0) {
457 pr_info(" sending SIGUSR2 to uim failed %ld", err);
458 err = ST_ERR_FAILURE;
459 continue;
460 }
461#else
462 /* unblock and send event to UIM via /dev/rfkill */
463 rfkill_set_hw_state(kim_gdata->rfkill[ST_BT], 0);
464#endif
465 /* wait for ldisc to be installed */
466 err = wait_for_completion_timeout(&kim_gdata->ldisc_installed,
467 msecs_to_jiffies(LDISC_TIME));
468 if (!err) { /* timeout */
469 pr_err("line disc installation timed out ");
470 err = ST_ERR_FAILURE;
471 continue;
472 } else {
473 /* ldisc installed now */
474 pr_info(" line discipline installed ");
475 err = download_firmware();
476 if (err != ST_SUCCESS) {
477 pr_err("download firmware failed");
478 continue;
479 } else { /* on success don't retry */
480 break;
481 }
482 }
483 } while (retry--);
484 return err;
485}
486
487/* called from ST Core, on the last un-registration
488*/
489long st_kim_stop(void)
490{
491 long err = ST_SUCCESS;
492
493 INIT_COMPLETION(kim_gdata->ldisc_installed);
494#ifndef LEGACY_RFKILL_SUPPORT
495 /* send signal to UIM */
496 err = kill_pid(find_get_pid(kim_gdata->uim_pid), SIGUSR2, 1);
497 if (err != 0) {
498 pr_err("sending SIGUSR2 to uim failed %ld", err);
499 return ST_ERR_FAILURE;
500 }
501#else
502 /* set BT rfkill to be blocked */
503 err = rfkill_set_hw_state(kim_gdata->rfkill[ST_BT], 1);
504#endif
505
506 /* wait for ldisc to be un-installed */
507 err = wait_for_completion_timeout(&kim_gdata->ldisc_installed,
508 msecs_to_jiffies(LDISC_TIME));
509 if (!err) { /* timeout */
510 pr_err(" timed out waiting for ldisc to be un-installed");
511 return ST_ERR_FAILURE;
512 }
513
514 /* By default configure BT nShutdown to LOW state */
515 gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_LOW);
516 mdelay(1);
517 gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_HIGH);
518 mdelay(1);
519 gpio_set_value(kim_gdata->gpios[ST_BT], GPIO_LOW);
520 return err;
521}
522
523/**********************************************************************/
524/* functions called from subsystems */
525
526#ifndef LEGACY_RFKILL_SUPPORT
527/* called when sysfs entry is written to */
528static ssize_t store_pid(struct device *dev, struct device_attribute
529 *devattr, char *buf, size_t count)
530{
531 pr_info("%s: pid %s ", __func__, buf);
532 sscanf(buf, "%ld", &kim_gdata->uim_pid);
533 /* to be made use by kim_start to signal SIGUSR2
534 */
535 return strlen(buf);
536}
537
538/* called when sysfs entry is read from */
539static ssize_t show_pid(struct device *dev, struct device_attribute
540 *attr, char *buf)
541{
542 sprintf(buf, "%ld", kim_gdata->uim_pid);
543 return strlen(buf);
544}
545
546/* called when sysfs entry is read from */
547static ssize_t show_list(struct device *dev, struct device_attribute
548 *attr, char *buf)
549{
550 kim_st_list_protocols(kim_gdata->core_data, buf);
551 return strlen(buf);
552}
553
554#else /* LEGACY_RFKILL_SUPPORT */
555
556/* function called from rfkill subsystem, when someone from
557 * user space would write 0/1 on the sysfs entry
558 * /sys/class/rfkill/rfkill0,1,3/state
559 */
560static int kim_toggle_radio(void *data, bool blocked)
561{
562 enum proto_type type = *((enum proto_type *)data);
563 pr_info(" %s: %d ", __func__, type);
564
565 switch (type) {
566 case ST_BT:
567 /* do nothing */
568 break;
569 case ST_FM:
570 case ST_GPS:
571 if (blocked)
572 st_kim_chip_toggle(type, KIM_GPIO_INACTIVE);
573 else
574 st_kim_chip_toggle(type, KIM_GPIO_ACTIVE);
575 break;
576 case ST_MAX:
577 pr_err(" wrong proto type ");
578 break;
579 }
580 return ST_SUCCESS;
581}
582
583#endif /* LEGACY_RFKILL_SUPPORT */
584
585void st_kim_ref(struct st_data_s **core_data)
586{
587 *core_data = kim_gdata->core_data;
588}
589
590/**********************************************************************/
591/* functions called from platform device driver subsystem
592 * need to have a relevant platform device entry in the platform's
593 * board-*.c file
594 */
595
596static int kim_probe(struct platform_device *pdev)
597{
598 long status;
599 long proto;
600 long *gpios = pdev->dev.platform_data;
601
602 status = st_core_init(&kim_gdata->core_data);
603 if (status != 0) {
604 pr_err(" ST core init failed");
605 return ST_ERR_FAILURE;
606 }
607
608 for (proto = 0; proto < ST_MAX; proto++) {
609 kim_gdata->gpios[proto] = gpios[proto];
610 pr_info(" %ld gpio to be requested", gpios[proto]);
611 }
612
613 for (proto = 0; (proto < ST_MAX) && (gpios[proto] != -1); proto++) {
614 /* Claim the Bluetooth/FM/GPIO
615 * nShutdown gpio from the system
616 */
617 status = gpio_request(gpios[proto], "kim");
618 if (unlikely(status)) {
619 pr_err(" gpio %ld request failed ", gpios[proto]);
620 proto -= 1;
621 while (proto >= 0) {
622 if (gpios[proto] != -1)
623 gpio_free(gpios[proto]);
624 }
625 return status;
626 }
627
628 /* Configure nShutdown GPIO as output=0 */
629 status =
630 gpio_direction_output(gpios[proto], 0);
631 if (unlikely(status)) {
632 pr_err(" unable to configure gpio %ld",
633 gpios[proto]);
634 proto -= 1;
635 while (proto >= 0) {
636 if (gpios[proto] != -1)
637 gpio_free(gpios[proto]);
638 }
639 return status;
640 }
641 }
642#ifndef LEGACY_RFKILL_SUPPORT
643 /* pdev to contain BT, FM and GPS enable/N-Shutdown GPIOs
644 * execute request_gpio, set output direction
645 */
646 kim_gdata->kim_kobj = kobject_create_and_add("uim", NULL);
647 /* create the sysfs entry for UIM to put in pid */
648 if (sysfs_create_group(kim_gdata->kim_kobj, &uim_attr_grp)) {
649 pr_err(" sysfs entry creation failed");
650 kobject_put(kim_gdata->kim_kobj);
651 /* free requested GPIOs and fail probe */
652 for (proto = ST_BT; proto < ST_MAX; proto++) {
653 if (gpios[proto] != -1)
654 gpio_free(gpios[proto]);
655 }
656 return -1; /* fail insmod */
657 }
658 pr_info(" sysfs entry created ");
659#endif
660 /* get reference of pdev for request_firmware
661 */
662 kim_gdata->kim_pdev = pdev;
663 init_completion(&kim_gdata->kim_rcvd);
664 init_completion(&kim_gdata->ldisc_installed);
665#ifdef LEGACY_RFKILL_SUPPORT
666 for (proto = 0; (proto < ST_MAX) && (gpios[proto] != -1); proto++) {
667 /* TODO: should all types be rfkill_type_bt ? */
668 kim_gdata->rf_protos[proto] = proto;
669 kim_gdata->rfkill[proto] = rfkill_alloc(protocol_names[proto],
670 &pdev->dev, RFKILL_TYPE_BLUETOOTH,
671 &kim_rfkill_ops, &kim_gdata->rf_protos[proto]);
672 if (kim_gdata->rfkill[proto] == NULL) {
673 pr_err("cannot create rfkill entry for gpio %ld",
674 gpios[proto]);
675 continue;
676 }
677 /* block upon creation */
678 rfkill_init_sw_state(kim_gdata->rfkill[proto], 1);
679 status = rfkill_register(kim_gdata->rfkill[proto]);
680 if (unlikely(status)) {
681 pr_err("rfkill registration failed for gpio %ld",
682 gpios[proto]);
683 rfkill_unregister(kim_gdata->rfkill[proto]);
684 continue;
685 }
686 pr_info("rfkill entry created for %ld", gpios[proto]);
687 }
688#endif
689 return ST_SUCCESS;
690}
691
692static int kim_remove(struct platform_device *pdev)
693{
694 /* free the GPIOs requested
695 */
696 long *gpios = pdev->dev.platform_data;
697 long proto;
698
699 for (proto = 0; (proto < ST_MAX) && (gpios[proto] != -1); proto++) {
700 /* Claim the Bluetooth/FM/GPIO
701 * nShutdown gpio from the system
702 */
703 gpio_free(gpios[proto]);
704#ifdef LEGACY_RFKILL_SUPPORT
705 rfkill_unregister(kim_gdata->rfkill[proto]);
706 rfkill_destroy(kim_gdata->rfkill[proto]);
707 kim_gdata->rfkill[proto] = NULL;
708#endif
709 }
710 pr_info("kim: GPIO Freed");
711#ifndef LEGACY_RFKILL_SUPPORT
712 /* delete the sysfs entries */
713 sysfs_remove_group(kim_gdata->kim_kobj, &uim_attr_grp);
714 kobject_put(kim_gdata->kim_kobj);
715#endif
716 kim_gdata->kim_pdev = NULL;
717 st_core_exit(kim_gdata->core_data);
718 return ST_SUCCESS;
719}
720
721/**********************************************************************/
722/* entry point for ST KIM module, called in from ST Core */
723
724static int __init st_kim_init(void)
725{
726 long ret = ST_SUCCESS;
727 kim_gdata = kzalloc(sizeof(struct kim_data_s), GFP_ATOMIC);
728 if (!kim_gdata) {
729 pr_err("no mem to allocate");
730 return -ENOMEM;
731 }
732
733 ret = platform_driver_register(&kim_platform_driver);
734 if (ret != 0) {
735 pr_err("platform drv registration failed");
736 return ST_ERR_FAILURE;
737 }
738 return ST_SUCCESS;
739}
740
741static void __exit st_kim_deinit(void)
742{
743 /* the following returns void */
744 platform_driver_unregister(&kim_platform_driver);
745 kfree(kim_gdata);
746 kim_gdata = NULL;
747}
748
749
750module_init(st_kim_init);
751module_exit(st_kim_deinit);
752MODULE_AUTHOR("Pavan Savoy <pavan_savoy@ti.com>");
753MODULE_DESCRIPTION("Shared Transport Driver for TI BT/FM/GPS combo chips ");
754MODULE_LICENSE("GPL");