1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#define pr_fmt(fmt) "(stk) :" fmt
24#include <linux/platform_device.h>
25#include <linux/jiffies.h>
26#include <linux/firmware.h>
27#include <linux/delay.h>
28#include <linux/wait.h>
29#include <linux/gpio.h>
30#include <linux/debugfs.h>
31#include <linux/seq_file.h>
32#include <linux/sched.h>
33#include <linux/sysfs.h>
34#include <linux/tty.h>
35
36#include <linux/skbuff.h>
37#include <linux/ti_wilink_st.h>
38#include <linux/module.h>
39
40
41#define MAX_ST_DEVICES 3
42static struct platform_device *st_kim_devices[MAX_ST_DEVICES];
43
44
45
46
47
48
49
50
51
52
53
54
55static struct platform_device *st_get_plat_device(int id)
56{
57 return st_kim_devices[id];
58}
59
60
61
62
63
64
65
66void validate_firmware_response(struct kim_data_s *kim_gdata)
67{
68 struct sk_buff *skb = kim_gdata->rx_skb;
69 if (unlikely(skb->data[5] != 0)) {
70 pr_err("no proper response during fw download");
71 pr_err("data6 %x", skb->data[5]);
72 kfree_skb(skb);
73 return;
74 }
75
76 complete_all(&kim_gdata->kim_rcvd);
77 kfree_skb(skb);
78}
79
80
81
82
83static inline int kim_check_data_len(struct kim_data_s *kim_gdata, int len)
84{
85 register int room = skb_tailroom(kim_gdata->rx_skb);
86
87 pr_debug("len %d room %d", len, room);
88
89 if (!len) {
90 validate_firmware_response(kim_gdata);
91 } else if (len > room) {
92
93
94
95 pr_err("Data length is too large len %d room %d", len,
96 room);
97 kfree_skb(kim_gdata->rx_skb);
98 } else {
99
100
101
102 kim_gdata->rx_state = ST_W4_DATA;
103 kim_gdata->rx_count = len;
104 return len;
105 }
106
107
108
109 kim_gdata->rx_state = ST_W4_PACKET_TYPE;
110 kim_gdata->rx_skb = NULL;
111 kim_gdata->rx_count = 0;
112
113 return 0;
114}
115
116
117
118
119
120
121
122void kim_int_recv(struct kim_data_s *kim_gdata,
123 const unsigned char *data, long count)
124{
125 const unsigned char *ptr;
126 int len = 0, type = 0;
127 unsigned char *plen;
128
129 pr_debug("%s", __func__);
130
131 ptr = data;
132 if (unlikely(ptr == NULL)) {
133 pr_err(" received null from TTY ");
134 return;
135 }
136
137 while (count) {
138 if (kim_gdata->rx_count) {
139 len = min_t(unsigned int, kim_gdata->rx_count, count);
140 memcpy(skb_put(kim_gdata->rx_skb, len), ptr, len);
141 kim_gdata->rx_count -= len;
142 count -= len;
143 ptr += len;
144
145 if (kim_gdata->rx_count)
146 continue;
147
148
149 switch (kim_gdata->rx_state) {
150
151 case ST_W4_DATA:
152 pr_debug("Complete pkt received");
153 validate_firmware_response(kim_gdata);
154 kim_gdata->rx_state = ST_W4_PACKET_TYPE;
155 kim_gdata->rx_skb = NULL;
156 continue;
157
158 case ST_W4_HEADER:
159 plen =
160 (unsigned char *)&kim_gdata->rx_skb->data[1];
161 pr_debug("event hdr: plen 0x%02x\n", *plen);
162 kim_check_data_len(kim_gdata, *plen);
163 continue;
164 }
165 }
166 switch (*ptr) {
167
168 case 0x04:
169 kim_gdata->rx_state = ST_W4_HEADER;
170 kim_gdata->rx_count = 2;
171 type = *ptr;
172 break;
173 default:
174 pr_info("unknown packet");
175 ptr++;
176 count--;
177 continue;
178 }
179 ptr++;
180 count--;
181 kim_gdata->rx_skb =
182 alloc_skb(1024+8, GFP_ATOMIC);
183 if (!kim_gdata->rx_skb) {
184 pr_err("can't allocate mem for new packet");
185 kim_gdata->rx_state = ST_W4_PACKET_TYPE;
186 kim_gdata->rx_count = 0;
187 return;
188 }
189 skb_reserve(kim_gdata->rx_skb, 8);
190 kim_gdata->rx_skb->cb[0] = 4;
191 kim_gdata->rx_skb->cb[1] = 0;
192
193 }
194 return;
195}
196
197static long read_local_version(struct kim_data_s *kim_gdata, char *bts_scr_name)
198{
199 unsigned short version = 0, chip = 0, min_ver = 0, maj_ver = 0;
200 const char read_ver_cmd[] = { 0x01, 0x01, 0x10, 0x00 };
201
202 pr_debug("%s", __func__);
203
204 INIT_COMPLETION(kim_gdata->kim_rcvd);
205 if (4 != st_int_write(kim_gdata->core_data, read_ver_cmd, 4)) {
206 pr_err("kim: couldn't write 4 bytes");
207 return -EIO;
208 }
209
210 if (!wait_for_completion_timeout
211 (&kim_gdata->kim_rcvd, msecs_to_jiffies(CMD_RESP_TIME))) {
212 pr_err(" waiting for ver info- timed out ");
213 return -ETIMEDOUT;
214 }
215 INIT_COMPLETION(kim_gdata->kim_rcvd);
216
217 version =
218 MAKEWORD(kim_gdata->resp_buffer[13],
219 kim_gdata->resp_buffer[14]);
220 chip = (version & 0x7C00) >> 10;
221 min_ver = (version & 0x007F);
222 maj_ver = (version & 0x0380) >> 7;
223
224 if (version & 0x8000)
225 maj_ver |= 0x0008;
226
227 sprintf(bts_scr_name, "TIInit_%d.%d.%d.bts", chip, maj_ver, min_ver);
228
229
230 kim_gdata->version.full = version;
231 kim_gdata->version.chip = chip;
232 kim_gdata->version.maj_ver = maj_ver;
233 kim_gdata->version.min_ver = min_ver;
234
235 pr_info("%s", bts_scr_name);
236 return 0;
237}
238
239void skip_change_remote_baud(unsigned char **ptr, long *len)
240{
241 unsigned char *nxt_action, *cur_action;
242 cur_action = *ptr;
243
244 nxt_action = cur_action + sizeof(struct bts_action) +
245 ((struct bts_action *) cur_action)->size;
246
247 if (((struct bts_action *) nxt_action)->type != ACTION_WAIT_EVENT) {
248 pr_err("invalid action after change remote baud command");
249 } else {
250 *ptr = *ptr + sizeof(struct bts_action) +
251 ((struct bts_action *)cur_action)->size;
252 *len = *len - (sizeof(struct bts_action) +
253 ((struct bts_action *)cur_action)->size);
254
255 pr_warn("skipping the wait event of change remote baud");
256 }
257}
258
259
260
261
262
263
264static long download_firmware(struct kim_data_s *kim_gdata)
265{
266 long err = 0;
267 long len = 0;
268 unsigned char *ptr = NULL;
269 unsigned char *action_ptr = NULL;
270 unsigned char bts_scr_name[30] = { 0 };
271 int wr_room_space;
272 int cmd_size;
273 unsigned long timeout;
274
275 err = read_local_version(kim_gdata, bts_scr_name);
276 if (err != 0) {
277 pr_err("kim: failed to read local ver");
278 return err;
279 }
280 err =
281 request_firmware(&kim_gdata->fw_entry, bts_scr_name,
282 &kim_gdata->kim_pdev->dev);
283 if (unlikely((err != 0) || (kim_gdata->fw_entry->data == NULL) ||
284 (kim_gdata->fw_entry->size == 0))) {
285 pr_err(" request_firmware failed(errno %ld) for %s", err,
286 bts_scr_name);
287 return -EINVAL;
288 }
289 ptr = (void *)kim_gdata->fw_entry->data;
290 len = kim_gdata->fw_entry->size;
291
292
293
294 ptr += sizeof(struct bts_header);
295 len -= sizeof(struct bts_header);
296
297 while (len > 0 && ptr) {
298 pr_debug(" action size %d, type %d ",
299 ((struct bts_action *)ptr)->size,
300 ((struct bts_action *)ptr)->type);
301
302 switch (((struct bts_action *)ptr)->type) {
303 case ACTION_SEND_COMMAND:
304 pr_debug("S");
305 action_ptr = &(((struct bts_action *)ptr)->data[0]);
306 if (unlikely
307 (((struct hci_command *)action_ptr)->opcode ==
308 0xFF36)) {
309
310
311 pr_warn("change remote baud"
312 " rate command in firmware");
313 skip_change_remote_baud(&ptr, &len);
314 break;
315 }
316
317
318
319
320 cmd_size = ((struct bts_action *)ptr)->size;
321 timeout = jiffies + msecs_to_jiffies(CMD_WR_TIME);
322 do {
323 wr_room_space =
324 st_get_uart_wr_room(kim_gdata->core_data);
325 if (wr_room_space < 0) {
326 pr_err("Unable to get free "
327 "space info from uart tx buffer");
328 release_firmware(kim_gdata->fw_entry);
329 return wr_room_space;
330 }
331 mdelay(1);
332 } while ((wr_room_space < cmd_size) &&
333 time_before(jiffies, timeout));
334
335
336 if (time_after_eq(jiffies, timeout)) {
337 pr_err("Timeout while waiting for free "
338 "free space in uart tx buffer");
339 release_firmware(kim_gdata->fw_entry);
340 return -ETIMEDOUT;
341 }
342
343
344
345 INIT_COMPLETION(kim_gdata->kim_rcvd);
346
347
348
349
350
351
352 err = st_int_write(kim_gdata->core_data,
353 ((struct bts_action_send *)action_ptr)->data,
354 ((struct bts_action *)ptr)->size);
355 if (unlikely(err < 0)) {
356 release_firmware(kim_gdata->fw_entry);
357 return err;
358 }
359
360
361
362
363 if (err != cmd_size) {
364 pr_err("Number of bytes written to uart "
365 "tx buffer are not matching with "
366 "requested cmd write size");
367 release_firmware(kim_gdata->fw_entry);
368 return -EIO;
369 }
370 break;
371 case ACTION_WAIT_EVENT:
372 pr_debug("W");
373 if (!wait_for_completion_timeout
374 (&kim_gdata->kim_rcvd,
375 msecs_to_jiffies(CMD_RESP_TIME))) {
376 pr_err("response timeout during fw download ");
377
378 release_firmware(kim_gdata->fw_entry);
379 return -ETIMEDOUT;
380 }
381 INIT_COMPLETION(kim_gdata->kim_rcvd);
382 break;
383 case ACTION_DELAY:
384 pr_info("sleep command in scr");
385 action_ptr = &(((struct bts_action *)ptr)->data[0]);
386 mdelay(((struct bts_action_delay *)action_ptr)->msec);
387 break;
388 }
389 len =
390 len - (sizeof(struct bts_action) +
391 ((struct bts_action *)ptr)->size);
392 ptr =
393 ptr + sizeof(struct bts_action) +
394 ((struct bts_action *)ptr)->size;
395 }
396
397 release_firmware(kim_gdata->fw_entry);
398 return 0;
399}
400
401
402
403
404
405
406
407
408void st_kim_recv(void *disc_data, const unsigned char *data, long count)
409{
410 struct st_data_s *st_gdata = (struct st_data_s *)disc_data;
411 struct kim_data_s *kim_gdata = st_gdata->kim_data;
412
413
414 if (unlikely(data[4] == 0x01 && data[5] == 0x10 && data[0] == 0x04)) {
415
416 memcpy(kim_gdata->resp_buffer, data, count);
417 complete_all(&kim_gdata->kim_rcvd);
418 return;
419 } else {
420 kim_int_recv(kim_gdata, data, count);
421
422 }
423 return;
424}
425
426
427
428
429void st_kim_complete(void *kim_data)
430{
431 struct kim_data_s *kim_gdata = (struct kim_data_s *)kim_data;
432 complete(&kim_gdata->ldisc_installed);
433}
434
435
436
437
438
439
440
441
442long st_kim_start(void *kim_data)
443{
444 long err = 0;
445 long retry = POR_RETRY_COUNT;
446 struct ti_st_plat_data *pdata;
447 struct kim_data_s *kim_gdata = (struct kim_data_s *)kim_data;
448
449 pr_info(" %s", __func__);
450 pdata = kim_gdata->kim_pdev->dev.platform_data;
451
452 do {
453
454 if (pdata->chip_enable)
455 pdata->chip_enable(kim_gdata);
456
457
458 gpio_set_value(kim_gdata->nshutdown, GPIO_LOW);
459 mdelay(5);
460 gpio_set_value(kim_gdata->nshutdown, GPIO_HIGH);
461 mdelay(100);
462
463 INIT_COMPLETION(kim_gdata->ldisc_installed);
464
465 kim_gdata->ldisc_install = 1;
466 pr_info("ldisc_install = 1");
467 sysfs_notify(&kim_gdata->kim_pdev->dev.kobj,
468 NULL, "install");
469
470 err = wait_for_completion_timeout(&kim_gdata->ldisc_installed,
471 msecs_to_jiffies(LDISC_TIME));
472 if (!err) {
473
474
475 pr_err("ldisc installation timeout");
476 err = st_kim_stop(kim_gdata);
477 continue;
478 } else {
479
480 pr_info("line discipline installed");
481 err = download_firmware(kim_gdata);
482 if (err != 0) {
483
484
485 pr_err("download firmware failed");
486 err = st_kim_stop(kim_gdata);
487 continue;
488 } else {
489 break;
490 }
491 }
492 } while (retry--);
493 return err;
494}
495
496
497
498
499
500
501
502
503
504
505
506long st_kim_stop(void *kim_data)
507{
508 long err = 0;
509 struct kim_data_s *kim_gdata = (struct kim_data_s *)kim_data;
510 struct ti_st_plat_data *pdata =
511 kim_gdata->kim_pdev->dev.platform_data;
512 struct tty_struct *tty = kim_gdata->core_data->tty;
513
514 INIT_COMPLETION(kim_gdata->ldisc_installed);
515
516 if (tty) {
517
518 tty_ldisc_flush(tty);
519 tty_driver_flush_buffer(tty);
520 tty->ops->flush_buffer(tty);
521 }
522
523
524 pr_info("ldisc_install = 0");
525 kim_gdata->ldisc_install = 0;
526 sysfs_notify(&kim_gdata->kim_pdev->dev.kobj, NULL, "install");
527
528
529 err = wait_for_completion_timeout(&kim_gdata->ldisc_installed,
530 msecs_to_jiffies(LDISC_TIME));
531 if (!err) {
532 pr_err(" timed out waiting for ldisc to be un-installed");
533 return -ETIMEDOUT;
534 }
535
536
537 gpio_set_value(kim_gdata->nshutdown, GPIO_LOW);
538 mdelay(1);
539 gpio_set_value(kim_gdata->nshutdown, GPIO_HIGH);
540 mdelay(1);
541 gpio_set_value(kim_gdata->nshutdown, GPIO_LOW);
542
543
544 if (pdata->chip_disable)
545 pdata->chip_disable(kim_gdata);
546 return err;
547}
548
549
550
551
552
553static int show_version(struct seq_file *s, void *unused)
554{
555 struct kim_data_s *kim_gdata = (struct kim_data_s *)s->private;
556 seq_printf(s, "%04X %d.%d.%d\n", kim_gdata->version.full,
557 kim_gdata->version.chip, kim_gdata->version.maj_ver,
558 kim_gdata->version.min_ver);
559 return 0;
560}
561
562static int show_list(struct seq_file *s, void *unused)
563{
564 struct kim_data_s *kim_gdata = (struct kim_data_s *)s->private;
565 kim_st_list_protocols(kim_gdata->core_data, s);
566 return 0;
567}
568
569static ssize_t show_install(struct device *dev,
570 struct device_attribute *attr, char *buf)
571{
572 struct kim_data_s *kim_data = dev_get_drvdata(dev);
573 return sprintf(buf, "%d\n", kim_data->ldisc_install);
574}
575
576#ifdef DEBUG
577static ssize_t store_dev_name(struct device *dev,
578 struct device_attribute *attr, const char *buf, size_t count)
579{
580 struct kim_data_s *kim_data = dev_get_drvdata(dev);
581 pr_debug("storing dev name >%s<", buf);
582 strncpy(kim_data->dev_name, buf, count);
583 pr_debug("stored dev name >%s<", kim_data->dev_name);
584 return count;
585}
586
587static ssize_t store_baud_rate(struct device *dev,
588 struct device_attribute *attr, const char *buf, size_t count)
589{
590 struct kim_data_s *kim_data = dev_get_drvdata(dev);
591 pr_debug("storing baud rate >%s<", buf);
592 sscanf(buf, "%ld", &kim_data->baud_rate);
593 pr_debug("stored baud rate >%ld<", kim_data->baud_rate);
594 return count;
595}
596#endif
597
598static ssize_t show_dev_name(struct device *dev,
599 struct device_attribute *attr, char *buf)
600{
601 struct kim_data_s *kim_data = dev_get_drvdata(dev);
602 return sprintf(buf, "%s\n", kim_data->dev_name);
603}
604
605static ssize_t show_baud_rate(struct device *dev,
606 struct device_attribute *attr, char *buf)
607{
608 struct kim_data_s *kim_data = dev_get_drvdata(dev);
609 return sprintf(buf, "%ld\n", kim_data->baud_rate);
610}
611
612static ssize_t show_flow_cntrl(struct device *dev,
613 struct device_attribute *attr, char *buf)
614{
615 struct kim_data_s *kim_data = dev_get_drvdata(dev);
616 return sprintf(buf, "%d\n", kim_data->flow_cntrl);
617}
618
619
620static struct kobj_attribute ldisc_install =
621__ATTR(install, 0444, (void *)show_install, NULL);
622
623static struct kobj_attribute uart_dev_name =
624#ifdef DEBUG
625__ATTR(dev_name, 0644, (void *)show_dev_name, (void *)store_dev_name);
626#else
627__ATTR(dev_name, 0444, (void *)show_dev_name, NULL);
628#endif
629
630static struct kobj_attribute uart_baud_rate =
631#ifdef DEBUG
632__ATTR(baud_rate, 0644, (void *)show_baud_rate, (void *)store_baud_rate);
633#else
634__ATTR(baud_rate, 0444, (void *)show_baud_rate, NULL);
635#endif
636
637static struct kobj_attribute uart_flow_cntrl =
638__ATTR(flow_cntrl, 0444, (void *)show_flow_cntrl, NULL);
639
640static struct attribute *uim_attrs[] = {
641 &ldisc_install.attr,
642 &uart_dev_name.attr,
643 &uart_baud_rate.attr,
644 &uart_flow_cntrl.attr,
645 NULL,
646};
647
648static struct attribute_group uim_attr_grp = {
649 .attrs = uim_attrs,
650};
651
652
653
654
655
656
657
658
659void st_kim_ref(struct st_data_s **core_data, int id)
660{
661 struct platform_device *pdev;
662 struct kim_data_s *kim_gdata;
663
664 pdev = st_get_plat_device(id);
665 if (!pdev) {
666 *core_data = NULL;
667 return;
668 }
669 kim_gdata = dev_get_drvdata(&pdev->dev);
670 *core_data = kim_gdata->core_data;
671}
672
673static int kim_version_open(struct inode *i, struct file *f)
674{
675 return single_open(f, show_version, i->i_private);
676}
677
678static int kim_list_open(struct inode *i, struct file *f)
679{
680 return single_open(f, show_list, i->i_private);
681}
682
683static const struct file_operations version_debugfs_fops = {
684
685 .open = kim_version_open,
686 .read = seq_read,
687 .llseek = seq_lseek,
688 .release = single_release,
689};
690static const struct file_operations list_debugfs_fops = {
691
692 .open = kim_list_open,
693 .read = seq_read,
694 .llseek = seq_lseek,
695 .release = single_release,
696};
697
698
699
700
701
702
703
704struct dentry *kim_debugfs_dir;
705static int kim_probe(struct platform_device *pdev)
706{
707 long status;
708 struct kim_data_s *kim_gdata;
709 struct ti_st_plat_data *pdata = pdev->dev.platform_data;
710
711 if ((pdev->id != -1) && (pdev->id < MAX_ST_DEVICES)) {
712
713 st_kim_devices[pdev->id] = pdev;
714 } else {
715
716 st_kim_devices[0] = pdev;
717 }
718
719 kim_gdata = kzalloc(sizeof(struct kim_data_s), GFP_ATOMIC);
720 if (!kim_gdata) {
721 pr_err("no mem to allocate");
722 return -ENOMEM;
723 }
724 dev_set_drvdata(&pdev->dev, kim_gdata);
725
726 status = st_core_init(&kim_gdata->core_data);
727 if (status != 0) {
728 pr_err(" ST core init failed");
729 return -EIO;
730 }
731
732 kim_gdata->core_data->kim_data = kim_gdata;
733
734
735 kim_gdata->nshutdown = pdata->nshutdown_gpio;
736 status = gpio_request(kim_gdata->nshutdown, "kim");
737 if (unlikely(status)) {
738 pr_err(" gpio %ld request failed ", kim_gdata->nshutdown);
739 return status;
740 }
741
742
743 status = gpio_direction_output(kim_gdata->nshutdown, 0);
744 if (unlikely(status)) {
745 pr_err(" unable to configure gpio %ld", kim_gdata->nshutdown);
746 return status;
747 }
748
749
750 kim_gdata->kim_pdev = pdev;
751 init_completion(&kim_gdata->kim_rcvd);
752 init_completion(&kim_gdata->ldisc_installed);
753
754 status = sysfs_create_group(&pdev->dev.kobj, &uim_attr_grp);
755 if (status) {
756 pr_err("failed to create sysfs entries");
757 return status;
758 }
759
760
761 strncpy(kim_gdata->dev_name, pdata->dev_name, UART_DEV_NAME_LEN);
762 kim_gdata->flow_cntrl = pdata->flow_cntrl;
763 kim_gdata->baud_rate = pdata->baud_rate;
764 pr_info("sysfs entries created\n");
765
766 kim_debugfs_dir = debugfs_create_dir("ti-st", NULL);
767 if (IS_ERR(kim_debugfs_dir)) {
768 pr_err(" debugfs entries creation failed ");
769 kim_debugfs_dir = NULL;
770 return -EIO;
771 }
772
773 debugfs_create_file("version", S_IRUGO, kim_debugfs_dir,
774 kim_gdata, &version_debugfs_fops);
775 debugfs_create_file("protocols", S_IRUGO, kim_debugfs_dir,
776 kim_gdata, &list_debugfs_fops);
777 pr_info(" debugfs entries created ");
778 return 0;
779}
780
781static int kim_remove(struct platform_device *pdev)
782{
783
784 struct ti_st_plat_data *pdata = pdev->dev.platform_data;
785 struct kim_data_s *kim_gdata;
786
787 kim_gdata = dev_get_drvdata(&pdev->dev);
788
789
790
791
792 gpio_free(pdata->nshutdown_gpio);
793 pr_info("nshutdown GPIO Freed");
794
795 debugfs_remove_recursive(kim_debugfs_dir);
796 sysfs_remove_group(&pdev->dev.kobj, &uim_attr_grp);
797 pr_info("sysfs entries removed");
798
799 kim_gdata->kim_pdev = NULL;
800 st_core_exit(kim_gdata->core_data);
801
802 kfree(kim_gdata);
803 kim_gdata = NULL;
804 return 0;
805}
806
807int kim_suspend(struct platform_device *pdev, pm_message_t state)
808{
809 struct ti_st_plat_data *pdata = pdev->dev.platform_data;
810
811 if (pdata->suspend)
812 return pdata->suspend(pdev, state);
813
814 return -EOPNOTSUPP;
815}
816
817int kim_resume(struct platform_device *pdev)
818{
819 struct ti_st_plat_data *pdata = pdev->dev.platform_data;
820
821 if (pdata->resume)
822 return pdata->resume(pdev);
823
824 return -EOPNOTSUPP;
825}
826
827
828
829static struct platform_driver kim_platform_driver = {
830 .probe = kim_probe,
831 .remove = kim_remove,
832 .suspend = kim_suspend,
833 .resume = kim_resume,
834 .driver = {
835 .name = "kim",
836 .owner = THIS_MODULE,
837 },
838};
839
840module_platform_driver(kim_platform_driver);
841
842MODULE_AUTHOR("Pavan Savoy <pavan_savoy@ti.com>");
843MODULE_DESCRIPTION("Shared Transport Driver for TI BT/FM/GPS combo chips ");
844MODULE_LICENSE("GPL");
845