hwa-hc.c 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851
  1. /*
  2. * Host Wire Adapter:
  3. * Driver glue, HWA-specific functions, bridges to WAHC and WUSBHC
  4. *
  5. * Copyright (C) 2005-2006 Intel Corporation
  6. * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
  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 version
  10. * 2 as published by the Free Software Foundation.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU 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 Street, Fifth Floor, Boston, MA
  20. * 02110-1301, USA.
  21. *
  22. *
  23. * The HWA driver is a simple layer that forwards requests to the WAHC
  24. * (Wire Adater Host Controller) or WUSBHC (Wireless USB Host
  25. * Controller) layers.
  26. *
  27. * Host Wire Adapter is the 'WUSB 1.0 standard' name for Wireless-USB
  28. * Host Controller that is connected to your system via USB (a USB
  29. * dongle that implements a USB host...). There is also a Device Wired
  30. * Adaptor, DWA (Wireless USB hub) that uses the same mechanism for
  31. * transferring data (it is after all a USB host connected via
  32. * Wireless USB), we have a common layer called Wire Adapter Host
  33. * Controller that does all the hard work. The WUSBHC (Wireless USB
  34. * Host Controller) is the part common to WUSB Host Controllers, the
  35. * HWA and the PCI-based one, that is implemented following the WHCI
  36. * spec. All these layers are implemented in ../wusbcore.
  37. *
  38. * The main functions are hwahc_op_urb_{en,de}queue(), that pass the
  39. * job of converting a URB to a Wire Adapter
  40. *
  41. * Entry points:
  42. *
  43. * hwahc_driver_*() Driver initialization, registration and
  44. * teardown.
  45. *
  46. * hwahc_probe() New device came up, create an instance for
  47. * it [from device enumeration].
  48. *
  49. * hwahc_disconnect() Remove device instance [from device
  50. * enumeration].
  51. *
  52. * [__]hwahc_op_*() Host-Wire-Adaptor specific functions for
  53. * starting/stopping/etc (some might be made also
  54. * DWA).
  55. */
  56. #include <linux/kernel.h>
  57. #include <linux/slab.h>
  58. #include <linux/module.h>
  59. #include <linux/workqueue.h>
  60. #include <linux/wait.h>
  61. #include <linux/completion.h>
  62. #include "../wusbcore/wa-hc.h"
  63. #include "../wusbcore/wusbhc.h"
  64. struct hwahc {
  65. struct wusbhc wusbhc; /* has to be 1st */
  66. struct wahc wa;
  67. };
  68. /*
  69. * FIXME should be wusbhc
  70. *
  71. * NOTE: we need to cache the Cluster ID because later...there is no
  72. * way to get it :)
  73. */
  74. static int __hwahc_set_cluster_id(struct hwahc *hwahc, u8 cluster_id)
  75. {
  76. int result;
  77. struct wusbhc *wusbhc = &hwahc->wusbhc;
  78. struct wahc *wa = &hwahc->wa;
  79. struct device *dev = &wa->usb_iface->dev;
  80. result = usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  81. WUSB_REQ_SET_CLUSTER_ID,
  82. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  83. cluster_id,
  84. wa->usb_iface->cur_altsetting->desc.bInterfaceNumber,
  85. NULL, 0, USB_CTRL_SET_TIMEOUT);
  86. if (result < 0)
  87. dev_err(dev, "Cannot set WUSB Cluster ID to 0x%02x: %d\n",
  88. cluster_id, result);
  89. else
  90. wusbhc->cluster_id = cluster_id;
  91. dev_info(dev, "Wireless USB Cluster ID set to 0x%02x\n", cluster_id);
  92. return result;
  93. }
  94. static int __hwahc_op_set_num_dnts(struct wusbhc *wusbhc, u8 interval, u8 slots)
  95. {
  96. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  97. struct wahc *wa = &hwahc->wa;
  98. return usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  99. WUSB_REQ_SET_NUM_DNTS,
  100. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  101. interval << 8 | slots,
  102. wa->usb_iface->cur_altsetting->desc.bInterfaceNumber,
  103. NULL, 0, USB_CTRL_SET_TIMEOUT);
  104. }
  105. /*
  106. * Reset a WUSB host controller and wait for it to complete doing it.
  107. *
  108. * @usb_hcd: Pointer to WUSB Host Controller instance.
  109. *
  110. */
  111. static int hwahc_op_reset(struct usb_hcd *usb_hcd)
  112. {
  113. int result;
  114. struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
  115. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  116. struct device *dev = &hwahc->wa.usb_iface->dev;
  117. mutex_lock(&wusbhc->mutex);
  118. wa_nep_disarm(&hwahc->wa);
  119. result = __wa_set_feature(&hwahc->wa, WA_RESET);
  120. if (result < 0) {
  121. dev_err(dev, "error commanding HC to reset: %d\n", result);
  122. goto error_unlock;
  123. }
  124. result = __wa_wait_status(&hwahc->wa, WA_STATUS_RESETTING, 0);
  125. if (result < 0) {
  126. dev_err(dev, "error waiting for HC to reset: %d\n", result);
  127. goto error_unlock;
  128. }
  129. error_unlock:
  130. mutex_unlock(&wusbhc->mutex);
  131. return result;
  132. }
  133. /*
  134. * FIXME: break this function up
  135. */
  136. static int hwahc_op_start(struct usb_hcd *usb_hcd)
  137. {
  138. u8 addr;
  139. int result;
  140. struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
  141. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  142. result = -ENOSPC;
  143. mutex_lock(&wusbhc->mutex);
  144. addr = wusb_cluster_id_get();
  145. if (addr == 0)
  146. goto error_cluster_id_get;
  147. result = __hwahc_set_cluster_id(hwahc, addr);
  148. if (result < 0)
  149. goto error_set_cluster_id;
  150. usb_hcd->uses_new_polling = 1;
  151. set_bit(HCD_FLAG_POLL_RH, &usb_hcd->flags);
  152. usb_hcd->state = HC_STATE_RUNNING;
  153. /*
  154. * prevent USB core from suspending the root hub since
  155. * bus_suspend and bus_resume are not yet supported.
  156. */
  157. pm_runtime_get_noresume(&usb_hcd->self.root_hub->dev);
  158. result = 0;
  159. out:
  160. mutex_unlock(&wusbhc->mutex);
  161. return result;
  162. error_set_cluster_id:
  163. wusb_cluster_id_put(wusbhc->cluster_id);
  164. error_cluster_id_get:
  165. goto out;
  166. }
  167. /*
  168. * No need to abort pipes, as when this is called, all the children
  169. * has been disconnected and that has done it [through
  170. * usb_disable_interface() -> usb_disable_endpoint() ->
  171. * hwahc_op_ep_disable() - >rpipe_ep_disable()].
  172. */
  173. static void hwahc_op_stop(struct usb_hcd *usb_hcd)
  174. {
  175. struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
  176. mutex_lock(&wusbhc->mutex);
  177. wusb_cluster_id_put(wusbhc->cluster_id);
  178. mutex_unlock(&wusbhc->mutex);
  179. }
  180. static int hwahc_op_get_frame_number(struct usb_hcd *usb_hcd)
  181. {
  182. struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
  183. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  184. struct wahc *wa = &hwahc->wa;
  185. /*
  186. * We cannot query the HWA for the WUSB time since that requires sending
  187. * a synchronous URB and this function can be called in_interrupt.
  188. * Instead, query the USB frame number for our parent and use that.
  189. */
  190. return usb_get_current_frame_number(wa->usb_dev);
  191. }
  192. static int hwahc_op_urb_enqueue(struct usb_hcd *usb_hcd, struct urb *urb,
  193. gfp_t gfp)
  194. {
  195. struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
  196. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  197. return wa_urb_enqueue(&hwahc->wa, urb->ep, urb, gfp);
  198. }
  199. static int hwahc_op_urb_dequeue(struct usb_hcd *usb_hcd, struct urb *urb,
  200. int status)
  201. {
  202. struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
  203. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  204. return wa_urb_dequeue(&hwahc->wa, urb, status);
  205. }
  206. /*
  207. * Release resources allocated for an endpoint
  208. *
  209. * If there is an associated rpipe to this endpoint, go ahead and put it.
  210. */
  211. static void hwahc_op_endpoint_disable(struct usb_hcd *usb_hcd,
  212. struct usb_host_endpoint *ep)
  213. {
  214. struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
  215. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  216. rpipe_ep_disable(&hwahc->wa, ep);
  217. }
  218. static int __hwahc_op_wusbhc_start(struct wusbhc *wusbhc)
  219. {
  220. int result;
  221. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  222. struct device *dev = &hwahc->wa.usb_iface->dev;
  223. result = __wa_set_feature(&hwahc->wa, WA_ENABLE);
  224. if (result < 0) {
  225. dev_err(dev, "error commanding HC to start: %d\n", result);
  226. goto error_stop;
  227. }
  228. result = __wa_wait_status(&hwahc->wa, WA_ENABLE, WA_ENABLE);
  229. if (result < 0) {
  230. dev_err(dev, "error waiting for HC to start: %d\n", result);
  231. goto error_stop;
  232. }
  233. result = wa_nep_arm(&hwahc->wa, GFP_KERNEL);
  234. if (result < 0) {
  235. dev_err(dev, "cannot listen to notifications: %d\n", result);
  236. goto error_stop;
  237. }
  238. return result;
  239. error_stop:
  240. __wa_clear_feature(&hwahc->wa, WA_ENABLE);
  241. return result;
  242. }
  243. static void __hwahc_op_wusbhc_stop(struct wusbhc *wusbhc, int delay)
  244. {
  245. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  246. struct wahc *wa = &hwahc->wa;
  247. u8 iface_no = wa->usb_iface->cur_altsetting->desc.bInterfaceNumber;
  248. int ret;
  249. ret = usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  250. WUSB_REQ_CHAN_STOP,
  251. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  252. delay * 1000,
  253. iface_no,
  254. NULL, 0, USB_CTRL_SET_TIMEOUT);
  255. if (ret == 0)
  256. msleep(delay);
  257. wa_nep_disarm(&hwahc->wa);
  258. __wa_stop(&hwahc->wa);
  259. }
  260. /*
  261. * Set the UWB MAS allocation for the WUSB cluster
  262. *
  263. * @stream_index: stream to use (-1 for cancelling the allocation)
  264. * @mas: mas bitmap to use
  265. */
  266. static int __hwahc_op_bwa_set(struct wusbhc *wusbhc, s8 stream_index,
  267. const struct uwb_mas_bm *mas)
  268. {
  269. int result;
  270. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  271. struct wahc *wa = &hwahc->wa;
  272. struct device *dev = &wa->usb_iface->dev;
  273. u8 mas_le[UWB_NUM_MAS/8];
  274. /* Set the stream index */
  275. result = usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  276. WUSB_REQ_SET_STREAM_IDX,
  277. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  278. stream_index,
  279. wa->usb_iface->cur_altsetting->desc.bInterfaceNumber,
  280. NULL, 0, USB_CTRL_SET_TIMEOUT);
  281. if (result < 0) {
  282. dev_err(dev, "Cannot set WUSB stream index: %d\n", result);
  283. goto out;
  284. }
  285. uwb_mas_bm_copy_le(mas_le, mas);
  286. /* Set the MAS allocation */
  287. result = usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  288. WUSB_REQ_SET_WUSB_MAS,
  289. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  290. 0, wa->usb_iface->cur_altsetting->desc.bInterfaceNumber,
  291. mas_le, 32, USB_CTRL_SET_TIMEOUT);
  292. if (result < 0)
  293. dev_err(dev, "Cannot set WUSB MAS allocation: %d\n", result);
  294. out:
  295. return result;
  296. }
  297. /*
  298. * Add an IE to the host's MMC
  299. *
  300. * @interval: See WUSB1.0[8.5.3.1]
  301. * @repeat_cnt: See WUSB1.0[8.5.3.1]
  302. * @handle: See WUSB1.0[8.5.3.1]
  303. * @wuie: Pointer to the header of the WUSB IE data to add.
  304. * MUST BE allocated in a kmalloc buffer (no stack or
  305. * vmalloc).
  306. *
  307. * NOTE: the format of the WUSB IEs for MMCs are different to the
  308. * normal MBOA MAC IEs (IE Id + Length in MBOA MAC vs. Length +
  309. * Id in WUSB IEs). Standards...you gotta love'em.
  310. */
  311. static int __hwahc_op_mmcie_add(struct wusbhc *wusbhc, u8 interval,
  312. u8 repeat_cnt, u8 handle,
  313. struct wuie_hdr *wuie)
  314. {
  315. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  316. struct wahc *wa = &hwahc->wa;
  317. u8 iface_no = wa->usb_iface->cur_altsetting->desc.bInterfaceNumber;
  318. return usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  319. WUSB_REQ_ADD_MMC_IE,
  320. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  321. interval << 8 | repeat_cnt,
  322. handle << 8 | iface_no,
  323. wuie, wuie->bLength, USB_CTRL_SET_TIMEOUT);
  324. }
  325. /*
  326. * Remove an IE to the host's MMC
  327. *
  328. * @handle: See WUSB1.0[8.5.3.1]
  329. */
  330. static int __hwahc_op_mmcie_rm(struct wusbhc *wusbhc, u8 handle)
  331. {
  332. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  333. struct wahc *wa = &hwahc->wa;
  334. u8 iface_no = wa->usb_iface->cur_altsetting->desc.bInterfaceNumber;
  335. return usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  336. WUSB_REQ_REMOVE_MMC_IE,
  337. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  338. 0, handle << 8 | iface_no,
  339. NULL, 0, USB_CTRL_SET_TIMEOUT);
  340. }
  341. /*
  342. * Update device information for a given fake port
  343. *
  344. * @port_idx: Fake port to which device is connected (wusbhc index, not
  345. * USB port number).
  346. */
  347. static int __hwahc_op_dev_info_set(struct wusbhc *wusbhc,
  348. struct wusb_dev *wusb_dev)
  349. {
  350. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  351. struct wahc *wa = &hwahc->wa;
  352. u8 iface_no = wa->usb_iface->cur_altsetting->desc.bInterfaceNumber;
  353. struct hwa_dev_info *dev_info;
  354. int ret;
  355. /* fill out the Device Info buffer and send it */
  356. dev_info = kzalloc(sizeof(struct hwa_dev_info), GFP_KERNEL);
  357. if (!dev_info)
  358. return -ENOMEM;
  359. uwb_mas_bm_copy_le(dev_info->bmDeviceAvailability,
  360. &wusb_dev->availability);
  361. dev_info->bDeviceAddress = wusb_dev->addr;
  362. /*
  363. * If the descriptors haven't been read yet, use a default PHY
  364. * rate of 53.3 Mbit/s only. The correct value will be used
  365. * when this will be called again as part of the
  366. * authentication process (which occurs after the descriptors
  367. * have been read).
  368. */
  369. if (wusb_dev->wusb_cap_descr)
  370. dev_info->wPHYRates = wusb_dev->wusb_cap_descr->wPHYRates;
  371. else
  372. dev_info->wPHYRates = cpu_to_le16(USB_WIRELESS_PHY_53);
  373. ret = usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  374. WUSB_REQ_SET_DEV_INFO,
  375. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  376. 0, wusb_dev->port_idx << 8 | iface_no,
  377. dev_info, sizeof(struct hwa_dev_info),
  378. USB_CTRL_SET_TIMEOUT);
  379. kfree(dev_info);
  380. return ret;
  381. }
  382. /*
  383. * Set host's idea of which encryption (and key) method to use when
  384. * talking to ad evice on a given port.
  385. *
  386. * If key is NULL, it means disable encryption for that "virtual port"
  387. * (used when we disconnect).
  388. */
  389. static int __hwahc_dev_set_key(struct wusbhc *wusbhc, u8 port_idx, u32 tkid,
  390. const void *key, size_t key_size,
  391. u8 key_idx)
  392. {
  393. int result = -ENOMEM;
  394. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  395. struct wahc *wa = &hwahc->wa;
  396. u8 iface_no = wa->usb_iface->cur_altsetting->desc.bInterfaceNumber;
  397. struct usb_key_descriptor *keyd;
  398. size_t keyd_len;
  399. keyd_len = sizeof(*keyd) + key_size;
  400. keyd = kzalloc(keyd_len, GFP_KERNEL);
  401. if (keyd == NULL)
  402. return -ENOMEM;
  403. keyd->bLength = keyd_len;
  404. keyd->bDescriptorType = USB_DT_KEY;
  405. keyd->tTKID[0] = (tkid >> 0) & 0xff;
  406. keyd->tTKID[1] = (tkid >> 8) & 0xff;
  407. keyd->tTKID[2] = (tkid >> 16) & 0xff;
  408. memcpy(keyd->bKeyData, key, key_size);
  409. result = usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  410. USB_REQ_SET_DESCRIPTOR,
  411. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  412. USB_DT_KEY << 8 | key_idx,
  413. port_idx << 8 | iface_no,
  414. keyd, keyd_len, USB_CTRL_SET_TIMEOUT);
  415. kzfree(keyd); /* clear keys etc. */
  416. return result;
  417. }
  418. /*
  419. * Set host's idea of which encryption (and key) method to use when
  420. * talking to ad evice on a given port.
  421. *
  422. * If key is NULL, it means disable encryption for that "virtual port"
  423. * (used when we disconnect).
  424. */
  425. static int __hwahc_op_set_ptk(struct wusbhc *wusbhc, u8 port_idx, u32 tkid,
  426. const void *key, size_t key_size)
  427. {
  428. int result = -ENOMEM;
  429. struct hwahc *hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  430. struct wahc *wa = &hwahc->wa;
  431. u8 iface_no = wa->usb_iface->cur_altsetting->desc.bInterfaceNumber;
  432. u8 encryption_value;
  433. /* Tell the host which key to use to talk to the device */
  434. if (key) {
  435. u8 key_idx = wusb_key_index(0, WUSB_KEY_INDEX_TYPE_PTK,
  436. WUSB_KEY_INDEX_ORIGINATOR_HOST);
  437. result = __hwahc_dev_set_key(wusbhc, port_idx, tkid,
  438. key, key_size, key_idx);
  439. if (result < 0)
  440. goto error_set_key;
  441. encryption_value = wusbhc->ccm1_etd->bEncryptionValue;
  442. } else {
  443. /* FIXME: this should come from wusbhc->etd[UNSECURE].value */
  444. encryption_value = 0;
  445. }
  446. /* Set the encryption type for communicating with the device */
  447. result = usb_control_msg(wa->usb_dev, usb_sndctrlpipe(wa->usb_dev, 0),
  448. USB_REQ_SET_ENCRYPTION,
  449. USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
  450. encryption_value, port_idx << 8 | iface_no,
  451. NULL, 0, USB_CTRL_SET_TIMEOUT);
  452. if (result < 0)
  453. dev_err(wusbhc->dev, "Can't set host's WUSB encryption for "
  454. "port index %u to %s (value %d): %d\n", port_idx,
  455. wusb_et_name(wusbhc->ccm1_etd->bEncryptionType),
  456. wusbhc->ccm1_etd->bEncryptionValue, result);
  457. error_set_key:
  458. return result;
  459. }
  460. /*
  461. * Set host's GTK key
  462. */
  463. static int __hwahc_op_set_gtk(struct wusbhc *wusbhc, u32 tkid,
  464. const void *key, size_t key_size)
  465. {
  466. u8 key_idx = wusb_key_index(0, WUSB_KEY_INDEX_TYPE_GTK,
  467. WUSB_KEY_INDEX_ORIGINATOR_HOST);
  468. return __hwahc_dev_set_key(wusbhc, 0, tkid, key, key_size, key_idx);
  469. }
  470. /*
  471. * Get the Wire Adapter class-specific descriptor
  472. *
  473. * NOTE: this descriptor comes with the big bundled configuration
  474. * descriptor that includes the interfaces' and endpoints', so
  475. * we just look for it in the cached copy kept by the USB stack.
  476. *
  477. * NOTE2: We convert LE fields to CPU order.
  478. */
  479. static int wa_fill_descr(struct wahc *wa)
  480. {
  481. int result;
  482. struct device *dev = &wa->usb_iface->dev;
  483. char *itr;
  484. struct usb_device *usb_dev = wa->usb_dev;
  485. struct usb_descriptor_header *hdr;
  486. struct usb_wa_descriptor *wa_descr;
  487. size_t itr_size, actconfig_idx;
  488. actconfig_idx = (usb_dev->actconfig - usb_dev->config) /
  489. sizeof(usb_dev->config[0]);
  490. itr = usb_dev->rawdescriptors[actconfig_idx];
  491. itr_size = le16_to_cpu(usb_dev->actconfig->desc.wTotalLength);
  492. while (itr_size >= sizeof(*hdr)) {
  493. hdr = (struct usb_descriptor_header *) itr;
  494. dev_dbg(dev, "Extra device descriptor: "
  495. "type %02x/%u bytes @ %zu (%zu left)\n",
  496. hdr->bDescriptorType, hdr->bLength,
  497. (itr - usb_dev->rawdescriptors[actconfig_idx]),
  498. itr_size);
  499. if (hdr->bDescriptorType == USB_DT_WIRE_ADAPTER)
  500. goto found;
  501. itr += hdr->bLength;
  502. itr_size -= hdr->bLength;
  503. }
  504. dev_err(dev, "cannot find Wire Adapter Class descriptor\n");
  505. return -ENODEV;
  506. found:
  507. result = -EINVAL;
  508. if (hdr->bLength > itr_size) { /* is it available? */
  509. dev_err(dev, "incomplete Wire Adapter Class descriptor "
  510. "(%zu bytes left, %u needed)\n",
  511. itr_size, hdr->bLength);
  512. goto error;
  513. }
  514. if (hdr->bLength < sizeof(*wa->wa_descr)) {
  515. dev_err(dev, "short Wire Adapter Class descriptor\n");
  516. goto error;
  517. }
  518. wa->wa_descr = wa_descr = (struct usb_wa_descriptor *) hdr;
  519. if (le16_to_cpu(wa_descr->bcdWAVersion) > 0x0100)
  520. dev_warn(dev, "Wire Adapter v%d.%d newer than groked v1.0\n",
  521. le16_to_cpu(wa_descr->bcdWAVersion) & 0xff00 >> 8,
  522. le16_to_cpu(wa_descr->bcdWAVersion) & 0x00ff);
  523. result = 0;
  524. error:
  525. return result;
  526. }
  527. static struct hc_driver hwahc_hc_driver = {
  528. .description = "hwa-hcd",
  529. .product_desc = "Wireless USB HWA host controller",
  530. .hcd_priv_size = sizeof(struct hwahc) - sizeof(struct usb_hcd),
  531. .irq = NULL, /* FIXME */
  532. .flags = HCD_USB25,
  533. .reset = hwahc_op_reset,
  534. .start = hwahc_op_start,
  535. .stop = hwahc_op_stop,
  536. .get_frame_number = hwahc_op_get_frame_number,
  537. .urb_enqueue = hwahc_op_urb_enqueue,
  538. .urb_dequeue = hwahc_op_urb_dequeue,
  539. .endpoint_disable = hwahc_op_endpoint_disable,
  540. .hub_status_data = wusbhc_rh_status_data,
  541. .hub_control = wusbhc_rh_control,
  542. .start_port_reset = wusbhc_rh_start_port_reset,
  543. };
  544. static int hwahc_security_create(struct hwahc *hwahc)
  545. {
  546. int result;
  547. struct wusbhc *wusbhc = &hwahc->wusbhc;
  548. struct usb_device *usb_dev = hwahc->wa.usb_dev;
  549. struct device *dev = &usb_dev->dev;
  550. struct usb_security_descriptor *secd;
  551. struct usb_encryption_descriptor *etd;
  552. void *itr, *top;
  553. size_t itr_size, needed, bytes;
  554. u8 index;
  555. char buf[64];
  556. /* Find the host's security descriptors in the config descr bundle */
  557. index = (usb_dev->actconfig - usb_dev->config) /
  558. sizeof(usb_dev->config[0]);
  559. itr = usb_dev->rawdescriptors[index];
  560. itr_size = le16_to_cpu(usb_dev->actconfig->desc.wTotalLength);
  561. top = itr + itr_size;
  562. result = __usb_get_extra_descriptor(usb_dev->rawdescriptors[index],
  563. le16_to_cpu(usb_dev->actconfig->desc.wTotalLength),
  564. USB_DT_SECURITY, (void **) &secd);
  565. if (result == -1) {
  566. dev_warn(dev, "BUG? WUSB host has no security descriptors\n");
  567. return 0;
  568. }
  569. needed = sizeof(*secd);
  570. if (top - (void *)secd < needed) {
  571. dev_err(dev, "BUG? Not enough data to process security "
  572. "descriptor header (%zu bytes left vs %zu needed)\n",
  573. top - (void *) secd, needed);
  574. return 0;
  575. }
  576. needed = le16_to_cpu(secd->wTotalLength);
  577. if (top - (void *)secd < needed) {
  578. dev_err(dev, "BUG? Not enough data to process security "
  579. "descriptors (%zu bytes left vs %zu needed)\n",
  580. top - (void *) secd, needed);
  581. return 0;
  582. }
  583. /* Walk over the sec descriptors and store CCM1's on wusbhc */
  584. itr = (void *) secd + sizeof(*secd);
  585. top = (void *) secd + le16_to_cpu(secd->wTotalLength);
  586. index = 0;
  587. bytes = 0;
  588. while (itr < top) {
  589. etd = itr;
  590. if (top - itr < sizeof(*etd)) {
  591. dev_err(dev, "BUG: bad host security descriptor; "
  592. "not enough data (%zu vs %zu left)\n",
  593. top - itr, sizeof(*etd));
  594. break;
  595. }
  596. if (etd->bLength < sizeof(*etd)) {
  597. dev_err(dev, "BUG: bad host encryption descriptor; "
  598. "descriptor is too short "
  599. "(%zu vs %zu needed)\n",
  600. (size_t)etd->bLength, sizeof(*etd));
  601. break;
  602. }
  603. itr += etd->bLength;
  604. bytes += snprintf(buf + bytes, sizeof(buf) - bytes,
  605. "%s (0x%02x) ",
  606. wusb_et_name(etd->bEncryptionType),
  607. etd->bEncryptionValue);
  608. wusbhc->ccm1_etd = etd;
  609. }
  610. dev_info(dev, "supported encryption types: %s\n", buf);
  611. if (wusbhc->ccm1_etd == NULL) {
  612. dev_err(dev, "E: host doesn't support CCM-1 crypto\n");
  613. return 0;
  614. }
  615. /* Pretty print what we support */
  616. return 0;
  617. }
  618. static void hwahc_security_release(struct hwahc *hwahc)
  619. {
  620. /* nothing to do here so far... */
  621. }
  622. static int hwahc_create(struct hwahc *hwahc, struct usb_interface *iface,
  623. kernel_ulong_t quirks)
  624. {
  625. int result;
  626. struct device *dev = &iface->dev;
  627. struct wusbhc *wusbhc = &hwahc->wusbhc;
  628. struct wahc *wa = &hwahc->wa;
  629. struct usb_device *usb_dev = interface_to_usbdev(iface);
  630. wa->usb_dev = usb_get_dev(usb_dev); /* bind the USB device */
  631. wa->usb_iface = usb_get_intf(iface);
  632. wusbhc->dev = dev;
  633. /* defer getting the uwb_rc handle until it is needed since it
  634. * may not have been registered by the hwa_rc driver yet. */
  635. wusbhc->uwb_rc = NULL;
  636. result = wa_fill_descr(wa); /* Get the device descriptor */
  637. if (result < 0)
  638. goto error_fill_descriptor;
  639. if (wa->wa_descr->bNumPorts > USB_MAXCHILDREN) {
  640. dev_err(dev, "FIXME: USB_MAXCHILDREN too low for WUSB "
  641. "adapter (%u ports)\n", wa->wa_descr->bNumPorts);
  642. wusbhc->ports_max = USB_MAXCHILDREN;
  643. } else {
  644. wusbhc->ports_max = wa->wa_descr->bNumPorts;
  645. }
  646. wusbhc->mmcies_max = wa->wa_descr->bNumMMCIEs;
  647. wusbhc->start = __hwahc_op_wusbhc_start;
  648. wusbhc->stop = __hwahc_op_wusbhc_stop;
  649. wusbhc->mmcie_add = __hwahc_op_mmcie_add;
  650. wusbhc->mmcie_rm = __hwahc_op_mmcie_rm;
  651. wusbhc->dev_info_set = __hwahc_op_dev_info_set;
  652. wusbhc->bwa_set = __hwahc_op_bwa_set;
  653. wusbhc->set_num_dnts = __hwahc_op_set_num_dnts;
  654. wusbhc->set_ptk = __hwahc_op_set_ptk;
  655. wusbhc->set_gtk = __hwahc_op_set_gtk;
  656. result = hwahc_security_create(hwahc);
  657. if (result < 0) {
  658. dev_err(dev, "Can't initialize security: %d\n", result);
  659. goto error_security_create;
  660. }
  661. wa->wusb = wusbhc; /* FIXME: ugly, need to fix */
  662. result = wusbhc_create(&hwahc->wusbhc);
  663. if (result < 0) {
  664. dev_err(dev, "Can't create WUSB HC structures: %d\n", result);
  665. goto error_wusbhc_create;
  666. }
  667. result = wa_create(&hwahc->wa, iface, quirks);
  668. if (result < 0)
  669. goto error_wa_create;
  670. return 0;
  671. error_wa_create:
  672. wusbhc_destroy(&hwahc->wusbhc);
  673. error_wusbhc_create:
  674. /* WA Descr fill allocs no resources */
  675. error_security_create:
  676. error_fill_descriptor:
  677. usb_put_intf(iface);
  678. usb_put_dev(usb_dev);
  679. return result;
  680. }
  681. static void hwahc_destroy(struct hwahc *hwahc)
  682. {
  683. struct wusbhc *wusbhc = &hwahc->wusbhc;
  684. mutex_lock(&wusbhc->mutex);
  685. __wa_destroy(&hwahc->wa);
  686. wusbhc_destroy(&hwahc->wusbhc);
  687. hwahc_security_release(hwahc);
  688. hwahc->wusbhc.dev = NULL;
  689. uwb_rc_put(wusbhc->uwb_rc);
  690. usb_put_intf(hwahc->wa.usb_iface);
  691. usb_put_dev(hwahc->wa.usb_dev);
  692. mutex_unlock(&wusbhc->mutex);
  693. }
  694. static void hwahc_init(struct hwahc *hwahc)
  695. {
  696. wa_init(&hwahc->wa);
  697. }
  698. static int hwahc_probe(struct usb_interface *usb_iface,
  699. const struct usb_device_id *id)
  700. {
  701. int result;
  702. struct usb_hcd *usb_hcd;
  703. struct wusbhc *wusbhc;
  704. struct hwahc *hwahc;
  705. struct device *dev = &usb_iface->dev;
  706. result = -ENOMEM;
  707. usb_hcd = usb_create_hcd(&hwahc_hc_driver, &usb_iface->dev, "wusb-hwa");
  708. if (usb_hcd == NULL) {
  709. dev_err(dev, "unable to allocate instance\n");
  710. goto error_alloc;
  711. }
  712. usb_hcd->wireless = 1;
  713. usb_hcd->self.sg_tablesize = ~0;
  714. wusbhc = usb_hcd_to_wusbhc(usb_hcd);
  715. hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  716. hwahc_init(hwahc);
  717. result = hwahc_create(hwahc, usb_iface, id->driver_info);
  718. if (result < 0) {
  719. dev_err(dev, "Cannot initialize internals: %d\n", result);
  720. goto error_hwahc_create;
  721. }
  722. result = usb_add_hcd(usb_hcd, 0, 0);
  723. if (result < 0) {
  724. dev_err(dev, "Cannot add HCD: %d\n", result);
  725. goto error_add_hcd;
  726. }
  727. device_wakeup_enable(usb_hcd->self.controller);
  728. result = wusbhc_b_create(&hwahc->wusbhc);
  729. if (result < 0) {
  730. dev_err(dev, "Cannot setup phase B of WUSBHC: %d\n", result);
  731. goto error_wusbhc_b_create;
  732. }
  733. return 0;
  734. error_wusbhc_b_create:
  735. usb_remove_hcd(usb_hcd);
  736. error_add_hcd:
  737. hwahc_destroy(hwahc);
  738. error_hwahc_create:
  739. usb_put_hcd(usb_hcd);
  740. error_alloc:
  741. return result;
  742. }
  743. static void hwahc_disconnect(struct usb_interface *usb_iface)
  744. {
  745. struct usb_hcd *usb_hcd;
  746. struct wusbhc *wusbhc;
  747. struct hwahc *hwahc;
  748. usb_hcd = usb_get_intfdata(usb_iface);
  749. wusbhc = usb_hcd_to_wusbhc(usb_hcd);
  750. hwahc = container_of(wusbhc, struct hwahc, wusbhc);
  751. wusbhc_b_destroy(&hwahc->wusbhc);
  752. usb_remove_hcd(usb_hcd);
  753. hwahc_destroy(hwahc);
  754. usb_put_hcd(usb_hcd);
  755. }
  756. static struct usb_device_id hwahc_id_table[] = {
  757. /* Alereon 5310 */
  758. { USB_DEVICE_AND_INTERFACE_INFO(0x13dc, 0x5310, 0xe0, 0x02, 0x01),
  759. .driver_info = WUSB_QUIRK_ALEREON_HWA_CONCAT_ISOC },
  760. /* Alereon 5611 */
  761. { USB_DEVICE_AND_INTERFACE_INFO(0x13dc, 0x5611, 0xe0, 0x02, 0x01),
  762. .driver_info = WUSB_QUIRK_ALEREON_HWA_CONCAT_ISOC },
  763. /* FIXME: use class labels for this */
  764. { USB_INTERFACE_INFO(0xe0, 0x02, 0x01), },
  765. {},
  766. };
  767. MODULE_DEVICE_TABLE(usb, hwahc_id_table);
  768. static struct usb_driver hwahc_driver = {
  769. .name = "hwa-hc",
  770. .probe = hwahc_probe,
  771. .disconnect = hwahc_disconnect,
  772. .id_table = hwahc_id_table,
  773. };
  774. module_usb_driver(hwahc_driver);
  775. MODULE_AUTHOR("Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>");
  776. MODULE_DESCRIPTION("Host Wired Adapter USB Host Control Driver");
  777. MODULE_LICENSE("GPL");