Commit | Line | Data |
---|---|---|
91eef3e2 PM |
1 | /* |
2 | * This file is part of Nokia H4P bluetooth driver | |
3 | * | |
4 | * Copyright (C) 2005-2008 Nokia Corporation. | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or | |
7 | * modify it under the terms of the GNU General Public License | |
8 | * version 2 as published by the Free Software Foundation. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, but | |
11 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
13 | * General Public License for more details. | |
14 | * | |
15 | * You should have received a copy of the GNU General Public License | |
16 | * along with this program; if not, write to the Free Software | |
17 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA | |
18 | * 02110-1301 USA | |
19 | * | |
20 | */ | |
21 | ||
22 | #include <linux/skbuff.h> | |
23 | #include <linux/delay.h> | |
24 | #include <linux/serial_reg.h> | |
25 | ||
26 | #include "hci_h4p.h" | |
27 | ||
28 | void hci_h4p_bc4_parse_fw_event(struct hci_h4p_info *info, struct sk_buff *skb) | |
29 | { | |
30 | /* Check if this is fw packet */ | |
31 | if (skb->data[0] != 0xff) { | |
32 | hci_recv_frame(info->hdev, skb); | |
33 | return; | |
34 | } | |
35 | ||
36 | if (skb->data[11] || skb->data[12]) { | |
37 | dev_err(info->dev, "Firmware sending command failed\n"); | |
38 | info->fw_error = -EPROTO; | |
39 | } | |
40 | ||
41 | kfree_skb(skb); | |
42 | complete(&info->fw_completion); | |
43 | } | |
44 | ||
45 | int hci_h4p_bc4_send_fw(struct hci_h4p_info *info, | |
46 | struct sk_buff_head *fw_queue) | |
47 | { | |
48 | static const u8 nokia_oui[3] = {0x00, 0x19, 0x4F}; | |
49 | struct sk_buff *skb; | |
50 | unsigned int offset; | |
51 | int retries, count, i, not_valid; | |
52 | unsigned long flags; | |
53 | ||
54 | info->fw_error = 0; | |
55 | ||
56 | BT_DBG("Sending firmware"); | |
57 | skb = skb_dequeue(fw_queue); | |
58 | ||
59 | if (!skb) | |
60 | return -ENOMSG; | |
61 | ||
62 | /* Check if this is bd_address packet */ | |
63 | if (skb->data[15] == 0x01 && skb->data[16] == 0x00) { | |
64 | offset = 21; | |
65 | skb->data[offset + 1] = 0x00; | |
66 | skb->data[offset + 5] = 0x00; | |
67 | ||
68 | not_valid = 1; | |
69 | for (i = 0; i < 6; i++) { | |
70 | if (info->bd_addr[i] != 0x00) { | |
71 | not_valid = 0; | |
72 | break; | |
73 | } | |
74 | } | |
75 | ||
76 | if (not_valid) { | |
a7175611 | 77 | dev_info(info->dev, "Valid bluetooth address not found, setting some random\n"); |
91eef3e2 PM |
78 | /* When address is not valid, use some random */ |
79 | memcpy(info->bd_addr, nokia_oui, 3); | |
80 | get_random_bytes(info->bd_addr + 3, 3); | |
81 | } | |
82 | ||
83 | skb->data[offset + 7] = info->bd_addr[0]; | |
84 | skb->data[offset + 6] = info->bd_addr[1]; | |
85 | skb->data[offset + 4] = info->bd_addr[2]; | |
86 | skb->data[offset + 0] = info->bd_addr[3]; | |
87 | skb->data[offset + 3] = info->bd_addr[4]; | |
88 | skb->data[offset + 2] = info->bd_addr[5]; | |
89 | } | |
90 | ||
91 | for (count = 1; ; count++) { | |
92 | BT_DBG("Sending firmware command %d", count); | |
93 | init_completion(&info->fw_completion); | |
94 | skb_queue_tail(&info->txq, skb); | |
95 | spin_lock_irqsave(&info->lock, flags); | |
96 | hci_h4p_outb(info, UART_IER, hci_h4p_inb(info, UART_IER) | | |
97 | UART_IER_THRI); | |
98 | spin_unlock_irqrestore(&info->lock, flags); | |
99 | ||
100 | skb = skb_dequeue(fw_queue); | |
101 | if (!skb) | |
102 | break; | |
103 | ||
104 | if (!wait_for_completion_timeout(&info->fw_completion, | |
105 | msecs_to_jiffies(1000))) { | |
106 | dev_err(info->dev, "No reply to fw command\n"); | |
107 | return -ETIMEDOUT; | |
108 | } | |
109 | ||
110 | if (info->fw_error) { | |
111 | dev_err(info->dev, "FW error\n"); | |
112 | return -EPROTO; | |
113 | } | |
114 | }; | |
115 | ||
116 | /* Wait for chip warm reset */ | |
117 | retries = 100; | |
118 | while ((!skb_queue_empty(&info->txq) || | |
119 | !(hci_h4p_inb(info, UART_LSR) & UART_LSR_TEMT)) && | |
120 | retries--) { | |
121 | msleep(10); | |
122 | } | |
123 | if (!retries) { | |
124 | dev_err(info->dev, "Transmitter not empty\n"); | |
125 | return -ETIMEDOUT; | |
126 | } | |
127 | ||
128 | hci_h4p_change_speed(info, BC4_MAX_BAUD_RATE); | |
129 | ||
130 | if (hci_h4p_wait_for_cts(info, 1, 100)) { | |
131 | dev_err(info->dev, "cts didn't deassert after final speed\n"); | |
132 | return -ETIMEDOUT; | |
133 | } | |
134 | ||
135 | retries = 100; | |
136 | do { | |
137 | init_completion(&info->init_completion); | |
138 | hci_h4p_send_alive_packet(info); | |
139 | retries--; | |
140 | } while (!wait_for_completion_timeout(&info->init_completion, 100) && | |
141 | retries > 0); | |
142 | ||
143 | if (!retries) { | |
144 | dev_err(info->dev, "No alive reply after speed change\n"); | |
145 | return -ETIMEDOUT; | |
146 | } | |
147 | ||
148 | return 0; | |
149 | } |