p54spi.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767
  1. /*
  2. * Copyright (C) 2008 Christian Lamparter <chunkeey@web.de>
  3. * Copyright 2008 Johannes Berg <johannes@sipsolutions.net>
  4. *
  5. * This driver is a port from stlc45xx:
  6. * Copyright (C) 2008 Nokia Corporation and/or its subsidiary(-ies).
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License
  10. * version 2 as published by the Free Software Foundation.
  11. *
  12. * This program is distributed in the hope that it will be useful, but
  13. * WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  15. * General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  20. * 02110-1301 USA
  21. */
  22. #include <linux/module.h>
  23. #include <linux/platform_device.h>
  24. #include <linux/interrupt.h>
  25. #include <linux/firmware.h>
  26. #include <linux/delay.h>
  27. #include <linux/irq.h>
  28. #include <linux/spi/spi.h>
  29. #include <linux/etherdevice.h>
  30. #include <linux/gpio.h>
  31. #include "p54spi.h"
  32. #include "p54spi_eeprom.h"
  33. #include "p54.h"
  34. #include "lmac.h"
  35. MODULE_FIRMWARE("3826.arm");
  36. MODULE_ALIAS("stlc45xx");
  37. /*
  38. * gpios should be handled in board files and provided via platform data,
  39. * but because it's currently impossible for p54spi to have a header file
  40. * in include/linux, let's use module paramaters for now
  41. */
  42. static int p54spi_gpio_power = 97;
  43. module_param(p54spi_gpio_power, int, 0444);
  44. MODULE_PARM_DESC(p54spi_gpio_power, "gpio number for power line");
  45. static int p54spi_gpio_irq = 87;
  46. module_param(p54spi_gpio_irq, int, 0444);
  47. MODULE_PARM_DESC(p54spi_gpio_irq, "gpio number for irq line");
  48. static void p54spi_spi_read(struct p54s_priv *priv, u8 address,
  49. void *buf, size_t len)
  50. {
  51. struct spi_transfer t[2];
  52. struct spi_message m;
  53. __le16 addr;
  54. /* We first push the address */
  55. addr = cpu_to_le16(address << 8 | SPI_ADRS_READ_BIT_15);
  56. spi_message_init(&m);
  57. memset(t, 0, sizeof(t));
  58. t[0].tx_buf = &addr;
  59. t[0].len = sizeof(addr);
  60. spi_message_add_tail(&t[0], &m);
  61. t[1].rx_buf = buf;
  62. t[1].len = len;
  63. spi_message_add_tail(&t[1], &m);
  64. spi_sync(priv->spi, &m);
  65. }
  66. static void p54spi_spi_write(struct p54s_priv *priv, u8 address,
  67. const void *buf, size_t len)
  68. {
  69. struct spi_transfer t[3];
  70. struct spi_message m;
  71. __le16 addr;
  72. /* We first push the address */
  73. addr = cpu_to_le16(address << 8);
  74. spi_message_init(&m);
  75. memset(t, 0, sizeof(t));
  76. t[0].tx_buf = &addr;
  77. t[0].len = sizeof(addr);
  78. spi_message_add_tail(&t[0], &m);
  79. t[1].tx_buf = buf;
  80. t[1].len = len & ~1;
  81. spi_message_add_tail(&t[1], &m);
  82. if (len % 2) {
  83. __le16 last_word;
  84. last_word = cpu_to_le16(((u8 *)buf)[len - 1]);
  85. t[2].tx_buf = &last_word;
  86. t[2].len = sizeof(last_word);
  87. spi_message_add_tail(&t[2], &m);
  88. }
  89. spi_sync(priv->spi, &m);
  90. }
  91. static u16 p54spi_read16(struct p54s_priv *priv, u8 addr)
  92. {
  93. __le16 val;
  94. p54spi_spi_read(priv, addr, &val, sizeof(val));
  95. return le16_to_cpu(val);
  96. }
  97. static u32 p54spi_read32(struct p54s_priv *priv, u8 addr)
  98. {
  99. __le32 val;
  100. p54spi_spi_read(priv, addr, &val, sizeof(val));
  101. return le32_to_cpu(val);
  102. }
  103. static inline void p54spi_write16(struct p54s_priv *priv, u8 addr, __le16 val)
  104. {
  105. p54spi_spi_write(priv, addr, &val, sizeof(val));
  106. }
  107. static inline void p54spi_write32(struct p54s_priv *priv, u8 addr, __le32 val)
  108. {
  109. p54spi_spi_write(priv, addr, &val, sizeof(val));
  110. }
  111. struct p54spi_spi_reg {
  112. u16 address; /* __le16 ? */
  113. u16 length;
  114. char *name;
  115. };
  116. static const struct p54spi_spi_reg p54spi_registers_array[] =
  117. {
  118. { SPI_ADRS_ARM_INTERRUPTS, 32, "ARM_INT " },
  119. { SPI_ADRS_ARM_INT_EN, 32, "ARM_INT_ENA " },
  120. { SPI_ADRS_HOST_INTERRUPTS, 32, "HOST_INT " },
  121. { SPI_ADRS_HOST_INT_EN, 32, "HOST_INT_ENA" },
  122. { SPI_ADRS_HOST_INT_ACK, 32, "HOST_INT_ACK" },
  123. { SPI_ADRS_GEN_PURP_1, 32, "GP1_COMM " },
  124. { SPI_ADRS_GEN_PURP_2, 32, "GP2_COMM " },
  125. { SPI_ADRS_DEV_CTRL_STAT, 32, "DEV_CTRL_STA" },
  126. { SPI_ADRS_DMA_DATA, 16, "DMA_DATA " },
  127. { SPI_ADRS_DMA_WRITE_CTRL, 16, "DMA_WR_CTRL " },
  128. { SPI_ADRS_DMA_WRITE_LEN, 16, "DMA_WR_LEN " },
  129. { SPI_ADRS_DMA_WRITE_BASE, 32, "DMA_WR_BASE " },
  130. { SPI_ADRS_DMA_READ_CTRL, 16, "DMA_RD_CTRL " },
  131. { SPI_ADRS_DMA_READ_LEN, 16, "DMA_RD_LEN " },
  132. { SPI_ADRS_DMA_WRITE_BASE, 32, "DMA_RD_BASE " }
  133. };
  134. static int p54spi_wait_bit(struct p54s_priv *priv, u16 reg, u32 bits)
  135. {
  136. int i;
  137. for (i = 0; i < 2000; i++) {
  138. u32 buffer = p54spi_read32(priv, reg);
  139. if ((buffer & bits) == bits)
  140. return 1;
  141. }
  142. return 0;
  143. }
  144. static int p54spi_spi_write_dma(struct p54s_priv *priv, __le32 base,
  145. const void *buf, size_t len)
  146. {
  147. if (!p54spi_wait_bit(priv, SPI_ADRS_DMA_WRITE_CTRL, HOST_ALLOWED)) {
  148. dev_err(&priv->spi->dev, "spi_write_dma not allowed "
  149. "to DMA write.\n");
  150. return -EAGAIN;
  151. }
  152. p54spi_write16(priv, SPI_ADRS_DMA_WRITE_CTRL,
  153. cpu_to_le16(SPI_DMA_WRITE_CTRL_ENABLE));
  154. p54spi_write16(priv, SPI_ADRS_DMA_WRITE_LEN, cpu_to_le16(len));
  155. p54spi_write32(priv, SPI_ADRS_DMA_WRITE_BASE, base);
  156. p54spi_spi_write(priv, SPI_ADRS_DMA_DATA, buf, len);
  157. return 0;
  158. }
  159. static int p54spi_request_firmware(struct ieee80211_hw *dev)
  160. {
  161. struct p54s_priv *priv = dev->priv;
  162. int ret;
  163. /* FIXME: should driver use it's own struct device? */
  164. ret = request_firmware(&priv->firmware, "3826.arm", &priv->spi->dev);
  165. if (ret < 0) {
  166. dev_err(&priv->spi->dev, "request_firmware() failed: %d", ret);
  167. return ret;
  168. }
  169. ret = p54_parse_firmware(dev, priv->firmware);
  170. if (ret) {
  171. release_firmware(priv->firmware);
  172. return ret;
  173. }
  174. return 0;
  175. }
  176. static int p54spi_request_eeprom(struct ieee80211_hw *dev)
  177. {
  178. struct p54s_priv *priv = dev->priv;
  179. const struct firmware *eeprom;
  180. int ret;
  181. /*
  182. * allow users to customize their eeprom.
  183. */
  184. ret = request_firmware(&eeprom, "3826.eeprom", &priv->spi->dev);
  185. if (ret < 0) {
  186. dev_info(&priv->spi->dev, "loading default eeprom...\n");
  187. ret = p54_parse_eeprom(dev, (void *) p54spi_eeprom,
  188. sizeof(p54spi_eeprom));
  189. } else {
  190. dev_info(&priv->spi->dev, "loading user eeprom...\n");
  191. ret = p54_parse_eeprom(dev, (void *) eeprom->data,
  192. (int)eeprom->size);
  193. release_firmware(eeprom);
  194. }
  195. return ret;
  196. }
  197. static int p54spi_upload_firmware(struct ieee80211_hw *dev)
  198. {
  199. struct p54s_priv *priv = dev->priv;
  200. unsigned long fw_len, _fw_len;
  201. unsigned int offset = 0;
  202. int err = 0;
  203. u8 *fw;
  204. fw_len = priv->firmware->size;
  205. fw = kmemdup(priv->firmware->data, fw_len, GFP_KERNEL);
  206. if (!fw)
  207. return -ENOMEM;
  208. /* stop the device */
  209. p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
  210. SPI_CTRL_STAT_HOST_OVERRIDE | SPI_CTRL_STAT_HOST_RESET |
  211. SPI_CTRL_STAT_START_HALTED));
  212. msleep(TARGET_BOOT_SLEEP);
  213. p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
  214. SPI_CTRL_STAT_HOST_OVERRIDE |
  215. SPI_CTRL_STAT_START_HALTED));
  216. msleep(TARGET_BOOT_SLEEP);
  217. while (fw_len > 0) {
  218. _fw_len = min_t(long, fw_len, SPI_MAX_PACKET_SIZE);
  219. err = p54spi_spi_write_dma(priv, cpu_to_le32(
  220. ISL38XX_DEV_FIRMWARE_ADDR + offset),
  221. (fw + offset), _fw_len);
  222. if (err < 0)
  223. goto out;
  224. fw_len -= _fw_len;
  225. offset += _fw_len;
  226. }
  227. BUG_ON(fw_len != 0);
  228. /* enable host interrupts */
  229. p54spi_write32(priv, SPI_ADRS_HOST_INT_EN,
  230. cpu_to_le32(SPI_HOST_INTS_DEFAULT));
  231. /* boot the device */
  232. p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
  233. SPI_CTRL_STAT_HOST_OVERRIDE | SPI_CTRL_STAT_HOST_RESET |
  234. SPI_CTRL_STAT_RAM_BOOT));
  235. msleep(TARGET_BOOT_SLEEP);
  236. p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
  237. SPI_CTRL_STAT_HOST_OVERRIDE | SPI_CTRL_STAT_RAM_BOOT));
  238. msleep(TARGET_BOOT_SLEEP);
  239. out:
  240. kfree(fw);
  241. return err;
  242. }
  243. static void p54spi_power_off(struct p54s_priv *priv)
  244. {
  245. disable_irq(gpio_to_irq(p54spi_gpio_irq));
  246. gpio_set_value(p54spi_gpio_power, 0);
  247. }
  248. static void p54spi_power_on(struct p54s_priv *priv)
  249. {
  250. gpio_set_value(p54spi_gpio_power, 1);
  251. enable_irq(gpio_to_irq(p54spi_gpio_irq));
  252. /*
  253. * need to wait a while before device can be accessed, the lenght
  254. * is just a guess
  255. */
  256. msleep(10);
  257. }
  258. static inline void p54spi_int_ack(struct p54s_priv *priv, u32 val)
  259. {
  260. p54spi_write32(priv, SPI_ADRS_HOST_INT_ACK, cpu_to_le32(val));
  261. }
  262. static int p54spi_wakeup(struct p54s_priv *priv)
  263. {
  264. /* wake the chip */
  265. p54spi_write32(priv, SPI_ADRS_ARM_INTERRUPTS,
  266. cpu_to_le32(SPI_TARGET_INT_WAKEUP));
  267. /* And wait for the READY interrupt */
  268. if (!p54spi_wait_bit(priv, SPI_ADRS_HOST_INTERRUPTS,
  269. SPI_HOST_INT_READY)) {
  270. dev_err(&priv->spi->dev, "INT_READY timeout\n");
  271. return -EBUSY;
  272. }
  273. p54spi_int_ack(priv, SPI_HOST_INT_READY);
  274. return 0;
  275. }
  276. static inline void p54spi_sleep(struct p54s_priv *priv)
  277. {
  278. p54spi_write32(priv, SPI_ADRS_ARM_INTERRUPTS,
  279. cpu_to_le32(SPI_TARGET_INT_SLEEP));
  280. }
  281. static void p54spi_int_ready(struct p54s_priv *priv)
  282. {
  283. p54spi_write32(priv, SPI_ADRS_HOST_INT_EN, cpu_to_le32(
  284. SPI_HOST_INT_UPDATE | SPI_HOST_INT_SW_UPDATE));
  285. switch (priv->fw_state) {
  286. case FW_STATE_BOOTING:
  287. priv->fw_state = FW_STATE_READY;
  288. complete(&priv->fw_comp);
  289. break;
  290. case FW_STATE_RESETTING:
  291. priv->fw_state = FW_STATE_READY;
  292. /* TODO: reinitialize state */
  293. break;
  294. default:
  295. break;
  296. }
  297. }
  298. static int p54spi_rx(struct p54s_priv *priv)
  299. {
  300. struct sk_buff *skb;
  301. u16 len;
  302. u16 rx_head[2];
  303. #define READAHEAD_SZ (sizeof(rx_head)-sizeof(u16))
  304. if (p54spi_wakeup(priv) < 0)
  305. return -EBUSY;
  306. /* Read data size and first data word in one SPI transaction
  307. * This is workaround for firmware/DMA bug,
  308. * when first data word gets lost under high load.
  309. */
  310. p54spi_spi_read(priv, SPI_ADRS_DMA_DATA, rx_head, sizeof(rx_head));
  311. len = rx_head[0];
  312. if (len == 0) {
  313. p54spi_sleep(priv);
  314. dev_err(&priv->spi->dev, "rx request of zero bytes\n");
  315. return 0;
  316. }
  317. /* Firmware may insert up to 4 padding bytes after the lmac header,
  318. * but it does not amend the size of SPI data transfer.
  319. * Such packets has correct data size in header, thus referencing
  320. * past the end of allocated skb. Reserve extra 4 bytes for this case */
  321. skb = dev_alloc_skb(len + 4);
  322. if (!skb) {
  323. p54spi_sleep(priv);
  324. dev_err(&priv->spi->dev, "could not alloc skb");
  325. return -ENOMEM;
  326. }
  327. if (len <= READAHEAD_SZ) {
  328. memcpy(skb_put(skb, len), rx_head + 1, len);
  329. } else {
  330. memcpy(skb_put(skb, READAHEAD_SZ), rx_head + 1, READAHEAD_SZ);
  331. p54spi_spi_read(priv, SPI_ADRS_DMA_DATA,
  332. skb_put(skb, len - READAHEAD_SZ),
  333. len - READAHEAD_SZ);
  334. }
  335. p54spi_sleep(priv);
  336. /* Put additional bytes to compensate for the possible
  337. * alignment-caused truncation */
  338. skb_put(skb, 4);
  339. if (p54_rx(priv->hw, skb) == 0)
  340. dev_kfree_skb(skb);
  341. return 0;
  342. }
  343. static irqreturn_t p54spi_interrupt(int irq, void *config)
  344. {
  345. struct spi_device *spi = config;
  346. struct p54s_priv *priv = dev_get_drvdata(&spi->dev);
  347. queue_work(priv->hw->workqueue, &priv->work);
  348. return IRQ_HANDLED;
  349. }
  350. static int p54spi_tx_frame(struct p54s_priv *priv, struct sk_buff *skb)
  351. {
  352. struct p54_hdr *hdr = (struct p54_hdr *) skb->data;
  353. int ret = 0;
  354. if (p54spi_wakeup(priv) < 0)
  355. return -EBUSY;
  356. ret = p54spi_spi_write_dma(priv, hdr->req_id, skb->data, skb->len);
  357. if (ret < 0)
  358. goto out;
  359. if (!p54spi_wait_bit(priv, SPI_ADRS_HOST_INTERRUPTS,
  360. SPI_HOST_INT_WR_READY)) {
  361. dev_err(&priv->spi->dev, "WR_READY timeout\n");
  362. ret = -EAGAIN;
  363. goto out;
  364. }
  365. p54spi_int_ack(priv, SPI_HOST_INT_WR_READY);
  366. if (FREE_AFTER_TX(skb))
  367. p54_free_skb(priv->hw, skb);
  368. out:
  369. p54spi_sleep(priv);
  370. return ret;
  371. }
  372. static int p54spi_wq_tx(struct p54s_priv *priv)
  373. {
  374. struct p54s_tx_info *entry;
  375. struct sk_buff *skb;
  376. struct ieee80211_tx_info *info;
  377. struct p54_tx_info *minfo;
  378. struct p54s_tx_info *dinfo;
  379. unsigned long flags;
  380. int ret = 0;
  381. spin_lock_irqsave(&priv->tx_lock, flags);
  382. while (!list_empty(&priv->tx_pending)) {
  383. entry = list_entry(priv->tx_pending.next,
  384. struct p54s_tx_info, tx_list);
  385. list_del_init(&entry->tx_list);
  386. spin_unlock_irqrestore(&priv->tx_lock, flags);
  387. dinfo = container_of((void *) entry, struct p54s_tx_info,
  388. tx_list);
  389. minfo = container_of((void *) dinfo, struct p54_tx_info,
  390. data);
  391. info = container_of((void *) minfo, struct ieee80211_tx_info,
  392. rate_driver_data);
  393. skb = container_of((void *) info, struct sk_buff, cb);
  394. ret = p54spi_tx_frame(priv, skb);
  395. if (ret < 0) {
  396. p54_free_skb(priv->hw, skb);
  397. return ret;
  398. }
  399. spin_lock_irqsave(&priv->tx_lock, flags);
  400. }
  401. spin_unlock_irqrestore(&priv->tx_lock, flags);
  402. return ret;
  403. }
  404. static void p54spi_op_tx(struct ieee80211_hw *dev, struct sk_buff *skb)
  405. {
  406. struct p54s_priv *priv = dev->priv;
  407. struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
  408. struct p54_tx_info *mi = (struct p54_tx_info *) info->rate_driver_data;
  409. struct p54s_tx_info *di = (struct p54s_tx_info *) mi->data;
  410. unsigned long flags;
  411. BUILD_BUG_ON(sizeof(*di) > sizeof((mi->data)));
  412. spin_lock_irqsave(&priv->tx_lock, flags);
  413. list_add_tail(&di->tx_list, &priv->tx_pending);
  414. spin_unlock_irqrestore(&priv->tx_lock, flags);
  415. queue_work(priv->hw->workqueue, &priv->work);
  416. }
  417. static void p54spi_work(struct work_struct *work)
  418. {
  419. struct p54s_priv *priv = container_of(work, struct p54s_priv, work);
  420. u32 ints;
  421. int ret;
  422. mutex_lock(&priv->mutex);
  423. if (priv->fw_state == FW_STATE_OFF)
  424. goto out;
  425. ints = p54spi_read32(priv, SPI_ADRS_HOST_INTERRUPTS);
  426. if (ints & SPI_HOST_INT_READY) {
  427. p54spi_int_ready(priv);
  428. p54spi_int_ack(priv, SPI_HOST_INT_READY);
  429. }
  430. if (priv->fw_state != FW_STATE_READY)
  431. goto out;
  432. if (ints & SPI_HOST_INT_UPDATE) {
  433. p54spi_int_ack(priv, SPI_HOST_INT_UPDATE);
  434. ret = p54spi_rx(priv);
  435. if (ret < 0)
  436. goto out;
  437. }
  438. if (ints & SPI_HOST_INT_SW_UPDATE) {
  439. p54spi_int_ack(priv, SPI_HOST_INT_SW_UPDATE);
  440. ret = p54spi_rx(priv);
  441. if (ret < 0)
  442. goto out;
  443. }
  444. ret = p54spi_wq_tx(priv);
  445. out:
  446. mutex_unlock(&priv->mutex);
  447. }
  448. static int p54spi_op_start(struct ieee80211_hw *dev)
  449. {
  450. struct p54s_priv *priv = dev->priv;
  451. unsigned long timeout;
  452. int ret = 0;
  453. if (mutex_lock_interruptible(&priv->mutex)) {
  454. ret = -EINTR;
  455. goto out;
  456. }
  457. priv->fw_state = FW_STATE_BOOTING;
  458. p54spi_power_on(priv);
  459. ret = p54spi_upload_firmware(dev);
  460. if (ret < 0) {
  461. p54spi_power_off(priv);
  462. goto out_unlock;
  463. }
  464. mutex_unlock(&priv->mutex);
  465. timeout = msecs_to_jiffies(2000);
  466. timeout = wait_for_completion_interruptible_timeout(&priv->fw_comp,
  467. timeout);
  468. if (!timeout) {
  469. dev_err(&priv->spi->dev, "firmware boot failed");
  470. p54spi_power_off(priv);
  471. ret = -1;
  472. goto out;
  473. }
  474. if (mutex_lock_interruptible(&priv->mutex)) {
  475. ret = -EINTR;
  476. p54spi_power_off(priv);
  477. goto out;
  478. }
  479. WARN_ON(priv->fw_state != FW_STATE_READY);
  480. out_unlock:
  481. mutex_unlock(&priv->mutex);
  482. out:
  483. return ret;
  484. }
  485. static void p54spi_op_stop(struct ieee80211_hw *dev)
  486. {
  487. struct p54s_priv *priv = dev->priv;
  488. unsigned long flags;
  489. if (mutex_lock_interruptible(&priv->mutex)) {
  490. /* FIXME: how to handle this error? */
  491. return;
  492. }
  493. WARN_ON(priv->fw_state != FW_STATE_READY);
  494. cancel_work_sync(&priv->work);
  495. p54spi_power_off(priv);
  496. spin_lock_irqsave(&priv->tx_lock, flags);
  497. INIT_LIST_HEAD(&priv->tx_pending);
  498. spin_unlock_irqrestore(&priv->tx_lock, flags);
  499. priv->fw_state = FW_STATE_OFF;
  500. mutex_unlock(&priv->mutex);
  501. }
  502. static int __devinit p54spi_probe(struct spi_device *spi)
  503. {
  504. struct p54s_priv *priv = NULL;
  505. struct ieee80211_hw *hw;
  506. int ret = -EINVAL;
  507. hw = p54_init_common(sizeof(*priv));
  508. if (!hw) {
  509. dev_err(&priv->spi->dev, "could not alloc ieee80211_hw");
  510. return -ENOMEM;
  511. }
  512. priv = hw->priv;
  513. priv->hw = hw;
  514. dev_set_drvdata(&spi->dev, priv);
  515. priv->spi = spi;
  516. spi->bits_per_word = 16;
  517. spi->max_speed_hz = 24000000;
  518. ret = spi_setup(spi);
  519. if (ret < 0) {
  520. dev_err(&priv->spi->dev, "spi_setup failed");
  521. goto err_free_common;
  522. }
  523. ret = gpio_request(p54spi_gpio_power, "p54spi power");
  524. if (ret < 0) {
  525. dev_err(&priv->spi->dev, "power GPIO request failed: %d", ret);
  526. goto err_free_common;
  527. }
  528. ret = gpio_request(p54spi_gpio_irq, "p54spi irq");
  529. if (ret < 0) {
  530. dev_err(&priv->spi->dev, "irq GPIO request failed: %d", ret);
  531. goto err_free_common;
  532. }
  533. gpio_direction_output(p54spi_gpio_power, 0);
  534. gpio_direction_input(p54spi_gpio_irq);
  535. ret = request_irq(gpio_to_irq(p54spi_gpio_irq),
  536. p54spi_interrupt, IRQF_DISABLED, "p54spi",
  537. priv->spi);
  538. if (ret < 0) {
  539. dev_err(&priv->spi->dev, "request_irq() failed");
  540. goto err_free_common;
  541. }
  542. set_irq_type(gpio_to_irq(p54spi_gpio_irq),
  543. IRQ_TYPE_EDGE_RISING);
  544. disable_irq(gpio_to_irq(p54spi_gpio_irq));
  545. INIT_WORK(&priv->work, p54spi_work);
  546. init_completion(&priv->fw_comp);
  547. INIT_LIST_HEAD(&priv->tx_pending);
  548. mutex_init(&priv->mutex);
  549. SET_IEEE80211_DEV(hw, &spi->dev);
  550. priv->common.open = p54spi_op_start;
  551. priv->common.stop = p54spi_op_stop;
  552. priv->common.tx = p54spi_op_tx;
  553. ret = p54spi_request_firmware(hw);
  554. if (ret < 0)
  555. goto err_free_common;
  556. ret = p54spi_request_eeprom(hw);
  557. if (ret)
  558. goto err_free_common;
  559. ret = p54_register_common(hw, &priv->spi->dev);
  560. if (ret)
  561. goto err_free_common;
  562. return 0;
  563. err_free_common:
  564. p54_free_common(priv->hw);
  565. return ret;
  566. }
  567. static int __devexit p54spi_remove(struct spi_device *spi)
  568. {
  569. struct p54s_priv *priv = dev_get_drvdata(&spi->dev);
  570. p54_unregister_common(priv->hw);
  571. free_irq(gpio_to_irq(p54spi_gpio_irq), spi);
  572. gpio_free(p54spi_gpio_power);
  573. gpio_free(p54spi_gpio_irq);
  574. release_firmware(priv->firmware);
  575. mutex_destroy(&priv->mutex);
  576. p54_free_common(priv->hw);
  577. return 0;
  578. }
  579. static struct spi_driver p54spi_driver = {
  580. .driver = {
  581. /* use cx3110x name because board-n800.c uses that for the
  582. * SPI port */
  583. .name = "cx3110x",
  584. .bus = &spi_bus_type,
  585. .owner = THIS_MODULE,
  586. },
  587. .probe = p54spi_probe,
  588. .remove = __devexit_p(p54spi_remove),
  589. };
  590. static int __init p54spi_init(void)
  591. {
  592. int ret;
  593. ret = spi_register_driver(&p54spi_driver);
  594. if (ret < 0) {
  595. printk(KERN_ERR "failed to register SPI driver: %d", ret);
  596. goto out;
  597. }
  598. out:
  599. return ret;
  600. }
  601. static void __exit p54spi_exit(void)
  602. {
  603. spi_unregister_driver(&p54spi_driver);
  604. }
  605. module_init(p54spi_init);
  606. module_exit(p54spi_exit);
  607. MODULE_LICENSE("GPL");
  608. MODULE_AUTHOR("Christian Lamparter <chunkeey@web.de>");