usb251xb.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594
  1. /*
  2. * Driver for Microchip USB251xB USB 2.0 Hi-Speed Hub Controller
  3. * Configuration via SMBus.
  4. *
  5. * Copyright (c) 2017 SKIDATA AG
  6. *
  7. * This work is based on the USB3503 driver by Dongjin Kim and
  8. * a not-accepted patch by Fabien Lahoudere, see:
  9. * https://patchwork.kernel.org/patch/9257715/
  10. *
  11. * This program is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License as published by
  13. * the Free Software Foundation; either version 2 of the License, or
  14. * (at your option) any later version.
  15. *
  16. * This program is distributed in the hope that it will be useful,
  17. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  19. * GNU General Public License for more details.
  20. */
  21. #include <linux/delay.h>
  22. #include <linux/gpio.h>
  23. #include <linux/i2c.h>
  24. #include <linux/module.h>
  25. #include <linux/nls.h>
  26. #include <linux/of_device.h>
  27. #include <linux/of_gpio.h>
  28. #include <linux/slab.h>
  29. /* Internal Register Set Addresses & Default Values acc. to DS00001692C */
  30. #define USB251XB_ADDR_VENDOR_ID_LSB 0x00
  31. #define USB251XB_ADDR_VENDOR_ID_MSB 0x01
  32. #define USB251XB_DEF_VENDOR_ID 0x0424
  33. #define USB251XB_ADDR_PRODUCT_ID_LSB 0x02
  34. #define USB251XB_ADDR_PRODUCT_ID_MSB 0x03
  35. #define USB251XB_DEF_PRODUCT_ID_12 0x2512 /* USB2512B/12Bi */
  36. #define USB251XB_DEF_PRODUCT_ID_13 0x2513 /* USB2513B/13Bi */
  37. #define USB251XB_DEF_PRODUCT_ID_14 0x2514 /* USB2514B/14Bi */
  38. #define USB251XB_ADDR_DEVICE_ID_LSB 0x04
  39. #define USB251XB_ADDR_DEVICE_ID_MSB 0x05
  40. #define USB251XB_DEF_DEVICE_ID 0x0BB3
  41. #define USB251XB_ADDR_CONFIG_DATA_1 0x06
  42. #define USB251XB_DEF_CONFIG_DATA_1 0x9B
  43. #define USB251XB_ADDR_CONFIG_DATA_2 0x07
  44. #define USB251XB_DEF_CONFIG_DATA_2 0x20
  45. #define USB251XB_ADDR_CONFIG_DATA_3 0x08
  46. #define USB251XB_DEF_CONFIG_DATA_3 0x02
  47. #define USB251XB_ADDR_NON_REMOVABLE_DEVICES 0x09
  48. #define USB251XB_DEF_NON_REMOVABLE_DEVICES 0x00
  49. #define USB251XB_ADDR_PORT_DISABLE_SELF 0x0A
  50. #define USB251XB_DEF_PORT_DISABLE_SELF 0x00
  51. #define USB251XB_ADDR_PORT_DISABLE_BUS 0x0B
  52. #define USB251XB_DEF_PORT_DISABLE_BUS 0x00
  53. #define USB251XB_ADDR_MAX_POWER_SELF 0x0C
  54. #define USB251XB_DEF_MAX_POWER_SELF 0x01
  55. #define USB251XB_ADDR_MAX_POWER_BUS 0x0D
  56. #define USB251XB_DEF_MAX_POWER_BUS 0x32
  57. #define USB251XB_ADDR_MAX_CURRENT_SELF 0x0E
  58. #define USB251XB_DEF_MAX_CURRENT_SELF 0x01
  59. #define USB251XB_ADDR_MAX_CURRENT_BUS 0x0F
  60. #define USB251XB_DEF_MAX_CURRENT_BUS 0x32
  61. #define USB251XB_ADDR_POWER_ON_TIME 0x10
  62. #define USB251XB_DEF_POWER_ON_TIME 0x32
  63. #define USB251XB_ADDR_LANGUAGE_ID_HIGH 0x11
  64. #define USB251XB_ADDR_LANGUAGE_ID_LOW 0x12
  65. #define USB251XB_DEF_LANGUAGE_ID 0x0000
  66. #define USB251XB_STRING_BUFSIZE 62
  67. #define USB251XB_ADDR_MANUFACTURER_STRING_LEN 0x13
  68. #define USB251XB_ADDR_MANUFACTURER_STRING 0x16
  69. #define USB251XB_DEF_MANUFACTURER_STRING "Microchip"
  70. #define USB251XB_ADDR_PRODUCT_STRING_LEN 0x14
  71. #define USB251XB_ADDR_PRODUCT_STRING 0x54
  72. #define USB251XB_DEF_PRODUCT_STRING "USB251xB/xBi"
  73. #define USB251XB_ADDR_SERIAL_STRING_LEN 0x15
  74. #define USB251XB_ADDR_SERIAL_STRING 0x92
  75. #define USB251XB_DEF_SERIAL_STRING ""
  76. #define USB251XB_ADDR_BATTERY_CHARGING_ENABLE 0xD0
  77. #define USB251XB_DEF_BATTERY_CHARGING_ENABLE 0x00
  78. #define USB251XB_ADDR_BOOST_UP 0xF6
  79. #define USB251XB_DEF_BOOST_UP 0x00
  80. #define USB251XB_ADDR_BOOST_X 0xF8
  81. #define USB251XB_DEF_BOOST_X 0x00
  82. #define USB251XB_ADDR_PORT_SWAP 0xFA
  83. #define USB251XB_DEF_PORT_SWAP 0x00
  84. #define USB251XB_ADDR_PORT_MAP_12 0xFB
  85. #define USB251XB_DEF_PORT_MAP_12 0x00
  86. #define USB251XB_ADDR_PORT_MAP_34 0xFC
  87. #define USB251XB_DEF_PORT_MAP_34 0x00 /* USB2513B/i & USB2514B/i only */
  88. #define USB251XB_ADDR_STATUS_COMMAND 0xFF
  89. #define USB251XB_STATUS_COMMAND_SMBUS_DOWN 0x04
  90. #define USB251XB_STATUS_COMMAND_RESET 0x02
  91. #define USB251XB_STATUS_COMMAND_ATTACH 0x01
  92. #define USB251XB_I2C_REG_SZ 0x100
  93. #define USB251XB_I2C_WRITE_SZ 0x10
  94. #define DRIVER_NAME "usb251xb"
  95. #define DRIVER_DESC "Microchip USB 2.0 Hi-Speed Hub Controller"
  96. #define DRIVER_VERSION "1.0"
  97. struct usb251xb {
  98. struct device *dev;
  99. struct i2c_client *i2c;
  100. u8 skip_config;
  101. int gpio_reset;
  102. u16 vendor_id;
  103. u16 product_id;
  104. u16 device_id;
  105. u8 conf_data1;
  106. u8 conf_data2;
  107. u8 conf_data3;
  108. u8 non_rem_dev;
  109. u8 port_disable_sp;
  110. u8 port_disable_bp;
  111. u8 max_power_sp;
  112. u8 max_power_bp;
  113. u8 max_current_sp;
  114. u8 max_current_bp;
  115. u8 power_on_time;
  116. u16 lang_id;
  117. u8 manufacturer_len;
  118. u8 product_len;
  119. u8 serial_len;
  120. char manufacturer[USB251XB_STRING_BUFSIZE];
  121. char product[USB251XB_STRING_BUFSIZE];
  122. char serial[USB251XB_STRING_BUFSIZE];
  123. u8 bat_charge_en;
  124. u8 boost_up;
  125. u8 boost_x;
  126. u8 port_swap;
  127. u8 port_map12;
  128. u8 port_map34;
  129. u8 status;
  130. };
  131. struct usb251xb_data {
  132. u16 product_id;
  133. char product_str[USB251XB_STRING_BUFSIZE / 2]; /* ASCII string */
  134. };
  135. static const struct usb251xb_data usb2512b_data = {
  136. .product_id = 0x2512,
  137. .product_str = "USB2512B",
  138. };
  139. static const struct usb251xb_data usb2512bi_data = {
  140. .product_id = 0x2512,
  141. .product_str = "USB2512Bi",
  142. };
  143. static const struct usb251xb_data usb2513b_data = {
  144. .product_id = 0x2513,
  145. .product_str = "USB2513B",
  146. };
  147. static const struct usb251xb_data usb2513bi_data = {
  148. .product_id = 0x2513,
  149. .product_str = "USB2513Bi",
  150. };
  151. static const struct usb251xb_data usb2514b_data = {
  152. .product_id = 0x2514,
  153. .product_str = "USB2514B",
  154. };
  155. static const struct usb251xb_data usb2514bi_data = {
  156. .product_id = 0x2514,
  157. .product_str = "USB2514Bi",
  158. };
  159. static void usb251xb_reset(struct usb251xb *hub, int state)
  160. {
  161. if (!gpio_is_valid(hub->gpio_reset))
  162. return;
  163. gpio_set_value_cansleep(hub->gpio_reset, state);
  164. /* wait for hub recovery/stabilization */
  165. if (state)
  166. usleep_range(500, 750); /* >=500us at power on */
  167. else
  168. usleep_range(1, 10); /* >=1us at power down */
  169. }
  170. static int usb251xb_connect(struct usb251xb *hub)
  171. {
  172. struct device *dev = hub->dev;
  173. int err, i;
  174. char i2c_wb[USB251XB_I2C_REG_SZ];
  175. memset(i2c_wb, 0, USB251XB_I2C_REG_SZ);
  176. if (hub->skip_config) {
  177. dev_info(dev, "Skip hub configuration, only attach.\n");
  178. i2c_wb[0] = 0x01;
  179. i2c_wb[1] = USB251XB_STATUS_COMMAND_ATTACH;
  180. usb251xb_reset(hub, 1);
  181. err = i2c_smbus_write_i2c_block_data(hub->i2c,
  182. USB251XB_ADDR_STATUS_COMMAND, 2, i2c_wb);
  183. if (err) {
  184. dev_err(dev, "attaching hub failed: %d\n", err);
  185. return err;
  186. }
  187. return 0;
  188. }
  189. i2c_wb[USB251XB_ADDR_VENDOR_ID_MSB] = (hub->vendor_id >> 8) & 0xFF;
  190. i2c_wb[USB251XB_ADDR_VENDOR_ID_LSB] = hub->vendor_id & 0xFF;
  191. i2c_wb[USB251XB_ADDR_PRODUCT_ID_MSB] = (hub->product_id >> 8) & 0xFF;
  192. i2c_wb[USB251XB_ADDR_PRODUCT_ID_LSB] = hub->product_id & 0xFF;
  193. i2c_wb[USB251XB_ADDR_DEVICE_ID_MSB] = (hub->device_id >> 8) & 0xFF;
  194. i2c_wb[USB251XB_ADDR_DEVICE_ID_LSB] = hub->device_id & 0xFF;
  195. i2c_wb[USB251XB_ADDR_CONFIG_DATA_1] = hub->conf_data1;
  196. i2c_wb[USB251XB_ADDR_CONFIG_DATA_2] = hub->conf_data2;
  197. i2c_wb[USB251XB_ADDR_CONFIG_DATA_3] = hub->conf_data3;
  198. i2c_wb[USB251XB_ADDR_NON_REMOVABLE_DEVICES] = hub->non_rem_dev;
  199. i2c_wb[USB251XB_ADDR_PORT_DISABLE_SELF] = hub->port_disable_sp;
  200. i2c_wb[USB251XB_ADDR_PORT_DISABLE_BUS] = hub->port_disable_bp;
  201. i2c_wb[USB251XB_ADDR_MAX_POWER_SELF] = hub->max_power_sp;
  202. i2c_wb[USB251XB_ADDR_MAX_POWER_BUS] = hub->max_power_bp;
  203. i2c_wb[USB251XB_ADDR_MAX_CURRENT_SELF] = hub->max_current_sp;
  204. i2c_wb[USB251XB_ADDR_MAX_CURRENT_BUS] = hub->max_current_bp;
  205. i2c_wb[USB251XB_ADDR_POWER_ON_TIME] = hub->power_on_time;
  206. i2c_wb[USB251XB_ADDR_LANGUAGE_ID_HIGH] = (hub->lang_id >> 8) & 0xFF;
  207. i2c_wb[USB251XB_ADDR_LANGUAGE_ID_LOW] = hub->lang_id & 0xFF;
  208. i2c_wb[USB251XB_ADDR_MANUFACTURER_STRING_LEN] = hub->manufacturer_len;
  209. i2c_wb[USB251XB_ADDR_PRODUCT_STRING_LEN] = hub->product_len;
  210. i2c_wb[USB251XB_ADDR_SERIAL_STRING_LEN] = hub->serial_len;
  211. memcpy(&i2c_wb[USB251XB_ADDR_MANUFACTURER_STRING], hub->manufacturer,
  212. USB251XB_STRING_BUFSIZE);
  213. memcpy(&i2c_wb[USB251XB_ADDR_SERIAL_STRING], hub->serial,
  214. USB251XB_STRING_BUFSIZE);
  215. memcpy(&i2c_wb[USB251XB_ADDR_PRODUCT_STRING], hub->product,
  216. USB251XB_STRING_BUFSIZE);
  217. i2c_wb[USB251XB_ADDR_BATTERY_CHARGING_ENABLE] = hub->bat_charge_en;
  218. i2c_wb[USB251XB_ADDR_BOOST_UP] = hub->boost_up;
  219. i2c_wb[USB251XB_ADDR_BOOST_X] = hub->boost_x;
  220. i2c_wb[USB251XB_ADDR_PORT_SWAP] = hub->port_swap;
  221. i2c_wb[USB251XB_ADDR_PORT_MAP_12] = hub->port_map12;
  222. i2c_wb[USB251XB_ADDR_PORT_MAP_34] = hub->port_map34;
  223. i2c_wb[USB251XB_ADDR_STATUS_COMMAND] = USB251XB_STATUS_COMMAND_ATTACH;
  224. usb251xb_reset(hub, 1);
  225. /* write registers */
  226. for (i = 0; i < (USB251XB_I2C_REG_SZ / USB251XB_I2C_WRITE_SZ); i++) {
  227. int offset = i * USB251XB_I2C_WRITE_SZ;
  228. char wbuf[USB251XB_I2C_WRITE_SZ + 1];
  229. /* The first data byte transferred tells the hub how many data
  230. * bytes will follow (byte count).
  231. */
  232. wbuf[0] = USB251XB_I2C_WRITE_SZ;
  233. memcpy(&wbuf[1], &i2c_wb[offset], USB251XB_I2C_WRITE_SZ);
  234. dev_dbg(dev, "writing %d byte block %d to 0x%02X\n",
  235. USB251XB_I2C_WRITE_SZ, i, offset);
  236. err = i2c_smbus_write_i2c_block_data(hub->i2c, offset,
  237. USB251XB_I2C_WRITE_SZ + 1,
  238. wbuf);
  239. if (err)
  240. goto out_err;
  241. }
  242. dev_info(dev, "Hub configuration was successful.\n");
  243. return 0;
  244. out_err:
  245. dev_err(dev, "configuring block %d failed: %d\n", i, err);
  246. return err;
  247. }
  248. #ifdef CONFIG_OF
  249. static int usb251xb_get_ofdata(struct usb251xb *hub,
  250. struct usb251xb_data *data)
  251. {
  252. struct device *dev = hub->dev;
  253. struct device_node *np = dev->of_node;
  254. int len, err, i;
  255. u32 *property_u32 = NULL;
  256. const u32 *cproperty_u32;
  257. const char *cproperty_char;
  258. char str[USB251XB_STRING_BUFSIZE / 2];
  259. if (!np) {
  260. dev_err(dev, "failed to get ofdata\n");
  261. return -ENODEV;
  262. }
  263. if (of_get_property(np, "skip-config", NULL))
  264. hub->skip_config = 1;
  265. else
  266. hub->skip_config = 0;
  267. hub->gpio_reset = of_get_named_gpio(np, "reset-gpios", 0);
  268. if (hub->gpio_reset == -EPROBE_DEFER)
  269. return -EPROBE_DEFER;
  270. if (gpio_is_valid(hub->gpio_reset)) {
  271. err = devm_gpio_request_one(dev, hub->gpio_reset,
  272. GPIOF_OUT_INIT_LOW,
  273. "usb251xb reset");
  274. if (err) {
  275. dev_err(dev,
  276. "unable to request GPIO %d as reset pin (%d)\n",
  277. hub->gpio_reset, err);
  278. return err;
  279. }
  280. }
  281. if (of_property_read_u16_array(np, "vendor-id", &hub->vendor_id, 1))
  282. hub->vendor_id = USB251XB_DEF_VENDOR_ID;
  283. if (of_property_read_u16_array(np, "product-id",
  284. &hub->product_id, 1))
  285. hub->product_id = data->product_id;
  286. if (of_property_read_u16_array(np, "device-id", &hub->device_id, 1))
  287. hub->device_id = USB251XB_DEF_DEVICE_ID;
  288. hub->conf_data1 = USB251XB_DEF_CONFIG_DATA_1;
  289. if (of_get_property(np, "self-powered", NULL)) {
  290. hub->conf_data1 |= BIT(7);
  291. /* Configure Over-Current sens when self-powered */
  292. hub->conf_data1 &= ~BIT(2);
  293. if (of_get_property(np, "ganged-sensing", NULL))
  294. hub->conf_data1 &= ~BIT(1);
  295. else if (of_get_property(np, "individual-sensing", NULL))
  296. hub->conf_data1 |= BIT(1);
  297. } else if (of_get_property(np, "bus-powered", NULL)) {
  298. hub->conf_data1 &= ~BIT(7);
  299. /* Disable Over-Current sense when bus-powered */
  300. hub->conf_data1 |= BIT(2);
  301. }
  302. if (of_get_property(np, "disable-hi-speed", NULL))
  303. hub->conf_data1 |= BIT(5);
  304. if (of_get_property(np, "multi-tt", NULL))
  305. hub->conf_data1 |= BIT(4);
  306. else if (of_get_property(np, "single-tt", NULL))
  307. hub->conf_data1 &= ~BIT(4);
  308. if (of_get_property(np, "disable-eop", NULL))
  309. hub->conf_data1 |= BIT(3);
  310. if (of_get_property(np, "individual-port-switching", NULL))
  311. hub->conf_data1 |= BIT(0);
  312. else if (of_get_property(np, "ganged-port-switching", NULL))
  313. hub->conf_data1 &= ~BIT(0);
  314. hub->conf_data2 = USB251XB_DEF_CONFIG_DATA_2;
  315. if (of_get_property(np, "dynamic-power-switching", NULL))
  316. hub->conf_data2 |= BIT(7);
  317. if (!of_property_read_u32(np, "oc-delay-us", property_u32)) {
  318. if (*property_u32 == 100) {
  319. /* 100 us*/
  320. hub->conf_data2 &= ~BIT(5);
  321. hub->conf_data2 &= ~BIT(4);
  322. } else if (*property_u32 == 4000) {
  323. /* 4 ms */
  324. hub->conf_data2 &= ~BIT(5);
  325. hub->conf_data2 |= BIT(4);
  326. } else if (*property_u32 == 16000) {
  327. /* 16 ms */
  328. hub->conf_data2 |= BIT(5);
  329. hub->conf_data2 |= BIT(4);
  330. } else {
  331. /* 8 ms (DEFAULT) */
  332. hub->conf_data2 |= BIT(5);
  333. hub->conf_data2 &= ~BIT(4);
  334. }
  335. }
  336. if (of_get_property(np, "compound-device", NULL))
  337. hub->conf_data2 |= BIT(3);
  338. hub->conf_data3 = USB251XB_DEF_CONFIG_DATA_3;
  339. if (of_get_property(np, "port-mapping-mode", NULL))
  340. hub->conf_data3 |= BIT(3);
  341. if (of_get_property(np, "string-support", NULL))
  342. hub->conf_data3 |= BIT(0);
  343. hub->non_rem_dev = USB251XB_DEF_NON_REMOVABLE_DEVICES;
  344. cproperty_u32 = of_get_property(np, "non-removable-ports", &len);
  345. if (cproperty_u32 && (len / sizeof(u32)) > 0) {
  346. for (i = 0; i < len / sizeof(u32); i++) {
  347. u32 port = be32_to_cpu(cproperty_u32[i]);
  348. if ((port >= 1) && (port <= 4))
  349. hub->non_rem_dev |= BIT(port);
  350. }
  351. }
  352. hub->port_disable_sp = USB251XB_DEF_PORT_DISABLE_SELF;
  353. cproperty_u32 = of_get_property(np, "sp-disabled-ports", &len);
  354. if (cproperty_u32 && (len / sizeof(u32)) > 0) {
  355. for (i = 0; i < len / sizeof(u32); i++) {
  356. u32 port = be32_to_cpu(cproperty_u32[i]);
  357. if ((port >= 1) && (port <= 4))
  358. hub->port_disable_sp |= BIT(port);
  359. }
  360. }
  361. hub->port_disable_bp = USB251XB_DEF_PORT_DISABLE_BUS;
  362. cproperty_u32 = of_get_property(np, "bp-disabled-ports", &len);
  363. if (cproperty_u32 && (len / sizeof(u32)) > 0) {
  364. for (i = 0; i < len / sizeof(u32); i++) {
  365. u32 port = be32_to_cpu(cproperty_u32[i]);
  366. if ((port >= 1) && (port <= 4))
  367. hub->port_disable_bp |= BIT(port);
  368. }
  369. }
  370. hub->power_on_time = USB251XB_DEF_POWER_ON_TIME;
  371. if (!of_property_read_u32(np, "power-on-time-ms", property_u32))
  372. hub->power_on_time = min_t(u8, *property_u32 / 2, 255);
  373. if (of_property_read_u16_array(np, "language-id", &hub->lang_id, 1))
  374. hub->lang_id = USB251XB_DEF_LANGUAGE_ID;
  375. cproperty_char = of_get_property(np, "manufacturer", NULL);
  376. strlcpy(str, cproperty_char ? : USB251XB_DEF_MANUFACTURER_STRING,
  377. sizeof(str));
  378. hub->manufacturer_len = strlen(str) & 0xFF;
  379. memset(hub->manufacturer, 0, USB251XB_STRING_BUFSIZE);
  380. len = min_t(size_t, USB251XB_STRING_BUFSIZE / 2, strlen(str));
  381. len = utf8s_to_utf16s(str, len, UTF16_LITTLE_ENDIAN,
  382. (wchar_t *)hub->manufacturer,
  383. USB251XB_STRING_BUFSIZE);
  384. cproperty_char = of_get_property(np, "product", NULL);
  385. strlcpy(str, cproperty_char ? : data->product_str, sizeof(str));
  386. hub->product_len = strlen(str) & 0xFF;
  387. memset(hub->product, 0, USB251XB_STRING_BUFSIZE);
  388. len = min_t(size_t, USB251XB_STRING_BUFSIZE / 2, strlen(str));
  389. len = utf8s_to_utf16s(str, len, UTF16_LITTLE_ENDIAN,
  390. (wchar_t *)hub->product,
  391. USB251XB_STRING_BUFSIZE);
  392. cproperty_char = of_get_property(np, "serial", NULL);
  393. strlcpy(str, cproperty_char ? : USB251XB_DEF_SERIAL_STRING,
  394. sizeof(str));
  395. hub->serial_len = strlen(str) & 0xFF;
  396. memset(hub->serial, 0, USB251XB_STRING_BUFSIZE);
  397. len = min_t(size_t, USB251XB_STRING_BUFSIZE / 2, strlen(str));
  398. len = utf8s_to_utf16s(str, len, UTF16_LITTLE_ENDIAN,
  399. (wchar_t *)hub->serial,
  400. USB251XB_STRING_BUFSIZE);
  401. /* The following parameters are currently not exposed to devicetree, but
  402. * may be as soon as needed.
  403. */
  404. hub->max_power_sp = USB251XB_DEF_MAX_POWER_SELF;
  405. hub->max_power_bp = USB251XB_DEF_MAX_POWER_BUS;
  406. hub->max_current_sp = USB251XB_DEF_MAX_CURRENT_SELF;
  407. hub->max_current_bp = USB251XB_DEF_MAX_CURRENT_BUS;
  408. hub->bat_charge_en = USB251XB_DEF_BATTERY_CHARGING_ENABLE;
  409. hub->boost_up = USB251XB_DEF_BOOST_UP;
  410. hub->boost_x = USB251XB_DEF_BOOST_X;
  411. hub->port_swap = USB251XB_DEF_PORT_SWAP;
  412. hub->port_map12 = USB251XB_DEF_PORT_MAP_12;
  413. hub->port_map34 = USB251XB_DEF_PORT_MAP_34;
  414. return 0;
  415. }
  416. static const struct of_device_id usb251xb_of_match[] = {
  417. {
  418. .compatible = "microchip,usb2512b",
  419. .data = &usb2512b_data,
  420. }, {
  421. .compatible = "microchip,usb2512bi",
  422. .data = &usb2512bi_data,
  423. }, {
  424. .compatible = "microchip,usb2513b",
  425. .data = &usb2513b_data,
  426. }, {
  427. .compatible = "microchip,usb2513bi",
  428. .data = &usb2513bi_data,
  429. }, {
  430. .compatible = "microchip,usb2514b",
  431. .data = &usb2514b_data,
  432. }, {
  433. .compatible = "microchip,usb2514bi",
  434. .data = &usb2514bi_data,
  435. }, {
  436. /* sentinel */
  437. }
  438. };
  439. MODULE_DEVICE_TABLE(of, usb251xb_of_match);
  440. #else /* CONFIG_OF */
  441. static int usb251xb_get_ofdata(struct usb251xb *hub,
  442. struct usb251xb_data *data)
  443. {
  444. return 0;
  445. }
  446. #endif /* CONFIG_OF */
  447. static int usb251xb_probe(struct usb251xb *hub)
  448. {
  449. struct device *dev = hub->dev;
  450. struct device_node *np = dev->of_node;
  451. const struct of_device_id *of_id = of_match_device(usb251xb_of_match,
  452. dev);
  453. int err;
  454. if (np) {
  455. err = usb251xb_get_ofdata(hub,
  456. (struct usb251xb_data *)of_id->data);
  457. if (err) {
  458. dev_err(dev, "failed to get ofdata: %d\n", err);
  459. return err;
  460. }
  461. }
  462. err = usb251xb_connect(hub);
  463. if (err) {
  464. dev_err(dev, "Failed to connect hub (%d)\n", err);
  465. return err;
  466. }
  467. dev_info(dev, "Hub probed successfully\n");
  468. return 0;
  469. }
  470. static int usb251xb_i2c_probe(struct i2c_client *i2c,
  471. const struct i2c_device_id *id)
  472. {
  473. struct usb251xb *hub;
  474. hub = devm_kzalloc(&i2c->dev, sizeof(struct usb251xb), GFP_KERNEL);
  475. if (!hub)
  476. return -ENOMEM;
  477. i2c_set_clientdata(i2c, hub);
  478. hub->dev = &i2c->dev;
  479. hub->i2c = i2c;
  480. return usb251xb_probe(hub);
  481. }
  482. static const struct i2c_device_id usb251xb_id[] = {
  483. { "usb2512b", 0 },
  484. { "usb2512bi", 0 },
  485. { "usb2513b", 0 },
  486. { "usb2513bi", 0 },
  487. { "usb2514b", 0 },
  488. { "usb2514bi", 0 },
  489. { /* sentinel */ }
  490. };
  491. MODULE_DEVICE_TABLE(i2c, usb251xb_id);
  492. static struct i2c_driver usb251xb_i2c_driver = {
  493. .driver = {
  494. .name = DRIVER_NAME,
  495. .of_match_table = of_match_ptr(usb251xb_of_match),
  496. },
  497. .probe = usb251xb_i2c_probe,
  498. .id_table = usb251xb_id,
  499. };
  500. module_i2c_driver(usb251xb_i2c_driver);
  501. MODULE_AUTHOR("Richard Leitner <richard.leitner@skidata.com>");
  502. MODULE_DESCRIPTION("USB251xB/xBi USB 2.0 Hub Controller Driver");
  503. MODULE_LICENSE("GPL");