]>
Commit | Line | Data |
---|---|---|
7bc04215 FF |
1 | /* |
2 | * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name> | |
3 | * | |
4 | * Permission to use, copy, modify, and/or distribute this software for any | |
5 | * purpose with or without fee is hereby granted, provided that the above | |
6 | * copyright notice and this permission notice appear in all copies. | |
7 | * | |
8 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | |
9 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | |
10 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR | |
11 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | |
12 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN | |
13 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF | |
14 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | |
15 | */ | |
16 | ||
17 | #include <linux/kernel.h> | |
18 | #include <linux/firmware.h> | |
19 | #include <linux/delay.h> | |
20 | ||
21 | #include "mt76x2.h" | |
1613c621 LB |
22 | #include "mcu.h" |
23 | #include "eeprom.h" | |
7bc04215 | 24 | |
7bc04215 | 25 | static int |
e40803f2 | 26 | mt76pci_load_rom_patch(struct mt76x02_dev *dev) |
7bc04215 FF |
27 | { |
28 | const struct firmware *fw = NULL; | |
79394f40 | 29 | struct mt76x02_patch_header *hdr; |
7bc04215 FF |
30 | bool rom_protect = !is_mt7612(dev); |
31 | int len, ret = 0; | |
32 | __le32 *cur; | |
33 | u32 patch_mask, patch_reg; | |
34 | ||
35 | if (rom_protect && !mt76_poll(dev, MT_MCU_SEMAPHORE_03, 1, 1, 600)) { | |
36 | dev_err(dev->mt76.dev, | |
37 | "Could not get hardware semaphore for ROM PATCH\n"); | |
38 | return -ETIMEDOUT; | |
39 | } | |
40 | ||
41 | if (mt76xx_rev(dev) >= MT76XX_REV_E3) { | |
42 | patch_mask = BIT(0); | |
43 | patch_reg = MT_MCU_CLOCK_CTL; | |
44 | } else { | |
45 | patch_mask = BIT(1); | |
46 | patch_reg = MT_MCU_COM_REG0; | |
47 | } | |
48 | ||
49 | if (rom_protect && (mt76_rr(dev, patch_reg) & patch_mask)) { | |
50 | dev_info(dev->mt76.dev, "ROM patch already applied\n"); | |
51 | goto out; | |
52 | } | |
53 | ||
54 | ret = request_firmware(&fw, MT7662_ROM_PATCH, dev->mt76.dev); | |
55 | if (ret) | |
56 | goto out; | |
57 | ||
58 | if (!fw || !fw->data || fw->size <= sizeof(*hdr)) { | |
59 | ret = -EIO; | |
60 | dev_err(dev->mt76.dev, "Failed to load firmware\n"); | |
61 | goto out; | |
62 | } | |
63 | ||
79394f40 | 64 | hdr = (struct mt76x02_patch_header *)fw->data; |
7bc04215 FF |
65 | dev_info(dev->mt76.dev, "ROM patch build: %.15s\n", hdr->build_time); |
66 | ||
67 | mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, MT_MCU_ROM_PATCH_OFFSET); | |
68 | ||
69 | cur = (__le32 *) (fw->data + sizeof(*hdr)); | |
70 | len = fw->size - sizeof(*hdr); | |
71 | mt76_wr_copy(dev, MT_MCU_ROM_PATCH_ADDR, cur, len); | |
72 | ||
73 | mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, 0); | |
74 | ||
75 | /* Trigger ROM */ | |
76 | mt76_wr(dev, MT_MCU_INT_LEVEL, 4); | |
77 | ||
78 | if (!mt76_poll_msec(dev, patch_reg, patch_mask, patch_mask, 2000)) { | |
79 | dev_err(dev->mt76.dev, "Failed to load ROM patch\n"); | |
80 | ret = -ETIMEDOUT; | |
81 | } | |
82 | ||
83 | out: | |
84 | /* release semaphore */ | |
85 | if (rom_protect) | |
86 | mt76_wr(dev, MT_MCU_SEMAPHORE_03, 1); | |
87 | release_firmware(fw); | |
88 | return ret; | |
89 | } | |
90 | ||
91 | static int | |
e40803f2 | 92 | mt76pci_load_firmware(struct mt76x02_dev *dev) |
7bc04215 FF |
93 | { |
94 | const struct firmware *fw; | |
79394f40 | 95 | const struct mt76x02_fw_header *hdr; |
db2ad7c2 | 96 | int len, ret; |
7bc04215 FF |
97 | __le32 *cur; |
98 | u32 offset, val; | |
99 | ||
100 | ret = request_firmware(&fw, MT7662_FIRMWARE, dev->mt76.dev); | |
101 | if (ret) | |
102 | return ret; | |
103 | ||
104 | if (!fw || !fw->data || fw->size < sizeof(*hdr)) | |
105 | goto error; | |
106 | ||
79394f40 | 107 | hdr = (const struct mt76x02_fw_header *)fw->data; |
7bc04215 FF |
108 | |
109 | len = sizeof(*hdr); | |
110 | len += le32_to_cpu(hdr->ilm_len); | |
111 | len += le32_to_cpu(hdr->dlm_len); | |
112 | ||
113 | if (fw->size != len) | |
114 | goto error; | |
115 | ||
116 | val = le16_to_cpu(hdr->fw_ver); | |
117 | dev_info(dev->mt76.dev, "Firmware Version: %d.%d.%02d\n", | |
118 | (val >> 12) & 0xf, (val >> 8) & 0xf, val & 0xf); | |
119 | ||
120 | val = le16_to_cpu(hdr->build_ver); | |
121 | dev_info(dev->mt76.dev, "Build: %x\n", val); | |
122 | dev_info(dev->mt76.dev, "Build Time: %.16s\n", hdr->build_time); | |
123 | ||
124 | cur = (__le32 *) (fw->data + sizeof(*hdr)); | |
125 | len = le32_to_cpu(hdr->ilm_len); | |
126 | ||
127 | mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, MT_MCU_ILM_OFFSET); | |
128 | mt76_wr_copy(dev, MT_MCU_ILM_ADDR, cur, len); | |
129 | ||
130 | cur += len / sizeof(*cur); | |
131 | len = le32_to_cpu(hdr->dlm_len); | |
132 | ||
133 | if (mt76xx_rev(dev) >= MT76XX_REV_E3) | |
134 | offset = MT_MCU_DLM_ADDR_E3; | |
135 | else | |
136 | offset = MT_MCU_DLM_ADDR; | |
137 | ||
138 | mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, MT_MCU_DLM_OFFSET); | |
139 | mt76_wr_copy(dev, offset, cur, len); | |
140 | ||
141 | mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, 0); | |
142 | ||
26a9daa6 | 143 | val = mt76x02_eeprom_get(dev, MT_EE_NIC_CONF_2); |
7bc04215 FF |
144 | if (FIELD_GET(MT_EE_NIC_CONF_2_XTAL_OPTION, val) == 1) |
145 | mt76_set(dev, MT_MCU_COM_REG0, BIT(30)); | |
146 | ||
147 | /* trigger firmware */ | |
148 | mt76_wr(dev, MT_MCU_INT_LEVEL, 2); | |
db2ad7c2 | 149 | if (!mt76_poll_msec(dev, MT_MCU_COM_REG0, 1, 1, 200)) { |
7bc04215 FF |
150 | dev_err(dev->mt76.dev, "Firmware failed to start\n"); |
151 | release_firmware(fw); | |
152 | return -ETIMEDOUT; | |
153 | } | |
154 | ||
499cd0aa | 155 | mt76x02_set_ethtool_fwver(dev, hdr); |
7bc04215 FF |
156 | dev_info(dev->mt76.dev, "Firmware running!\n"); |
157 | ||
158 | release_firmware(fw); | |
159 | ||
160 | return ret; | |
161 | ||
162 | error: | |
163 | dev_err(dev->mt76.dev, "Invalid firmware\n"); | |
164 | release_firmware(fw); | |
165 | return -ENOENT; | |
166 | } | |
167 | ||
00496042 FF |
168 | static int |
169 | mt76pci_mcu_restart(struct mt76_dev *mdev) | |
170 | { | |
171 | struct mt76x02_dev *dev; | |
172 | int ret; | |
173 | ||
174 | dev = container_of(mdev, struct mt76x02_dev, mt76); | |
175 | ||
176 | mt76x02_mcu_cleanup(dev); | |
177 | mt76x2_mac_reset(dev, true); | |
178 | ||
179 | ret = mt76pci_load_firmware(dev); | |
180 | if (ret) | |
181 | return ret; | |
182 | ||
183 | mt76_wr(dev, MT_WPDMA_RST_IDX, ~0); | |
184 | ||
185 | return 0; | |
186 | } | |
187 | ||
e40803f2 | 188 | int mt76x2_mcu_init(struct mt76x02_dev *dev) |
7bc04215 | 189 | { |
8cff1237 | 190 | static const struct mt76_mcu_ops mt76x2_mcu_ops = { |
00496042 | 191 | .mcu_restart = mt76pci_mcu_restart, |
36fd09dd | 192 | .mcu_send_msg = mt76x02_mcu_msg_send, |
8cff1237 | 193 | }; |
7bc04215 FF |
194 | int ret; |
195 | ||
8cff1237 LB |
196 | dev->mt76.mcu_ops = &mt76x2_mcu_ops; |
197 | ||
7bc04215 FF |
198 | ret = mt76pci_load_rom_patch(dev); |
199 | if (ret) | |
200 | return ret; | |
201 | ||
202 | ret = mt76pci_load_firmware(dev); | |
203 | if (ret) | |
204 | return ret; | |
205 | ||
3d2d61b5 | 206 | mt76x02_mcu_function_select(dev, Q_SELECT, 1); |
7bc04215 FF |
207 | return 0; |
208 | } |