leds-blinkm.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815
  1. /*
  2. * leds-blinkm.c
  3. * (c) Jan-Simon Möller (dl9pf@gmx.de)
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation; either version 2 of the License, or
  8. * (at your option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU 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., 675 Mass Ave, Cambridge, MA 02139, USA.
  18. */
  19. #include <linux/module.h>
  20. #include <linux/init.h>
  21. #include <linux/slab.h>
  22. #include <linux/jiffies.h>
  23. #include <linux/i2c.h>
  24. #include <linux/err.h>
  25. #include <linux/mutex.h>
  26. #include <linux/sysfs.h>
  27. #include <linux/printk.h>
  28. #include <linux/pm_runtime.h>
  29. #include <linux/leds.h>
  30. #include <linux/delay.h>
  31. /* Addresses to scan - BlinkM is on 0x09 by default*/
  32. static const unsigned short normal_i2c[] = { 0x09, I2C_CLIENT_END };
  33. static int blinkm_transfer_hw(struct i2c_client *client, int cmd);
  34. static int blinkm_test_run(struct i2c_client *client);
  35. struct blinkm_led {
  36. struct i2c_client *i2c_client;
  37. struct led_classdev led_cdev;
  38. int id;
  39. atomic_t active;
  40. };
  41. struct blinkm_work {
  42. struct blinkm_led *blinkm_led;
  43. struct work_struct work;
  44. };
  45. #define cdev_to_blmled(c) container_of(c, struct blinkm_led, led_cdev)
  46. #define work_to_blmwork(c) container_of(c, struct blinkm_work, work)
  47. struct blinkm_data {
  48. struct i2c_client *i2c_client;
  49. struct mutex update_lock;
  50. /* used for led class interface */
  51. struct blinkm_led blinkm_leds[3];
  52. /* used for "blinkm" sysfs interface */
  53. u8 red; /* color red */
  54. u8 green; /* color green */
  55. u8 blue; /* color blue */
  56. /* next values to use for transfer */
  57. u8 next_red; /* color red */
  58. u8 next_green; /* color green */
  59. u8 next_blue; /* color blue */
  60. /* internal use */
  61. u8 args[7]; /* set of args for transmission */
  62. u8 i2c_addr; /* i2c addr */
  63. u8 fw_ver; /* firmware version */
  64. /* used, but not from userspace */
  65. u8 hue; /* HSB hue */
  66. u8 saturation; /* HSB saturation */
  67. u8 brightness; /* HSB brightness */
  68. u8 next_hue; /* HSB hue */
  69. u8 next_saturation; /* HSB saturation */
  70. u8 next_brightness; /* HSB brightness */
  71. /* currently unused / todo */
  72. u8 fade_speed; /* fade speed 1 - 255 */
  73. s8 time_adjust; /* time adjust -128 - 127 */
  74. u8 fade:1; /* fade on = 1, off = 0 */
  75. u8 rand:1; /* rand fade mode on = 1 */
  76. u8 script_id; /* script ID */
  77. u8 script_repeats; /* repeats of script */
  78. u8 script_startline; /* line to start */
  79. };
  80. /* Colors */
  81. #define RED 0
  82. #define GREEN 1
  83. #define BLUE 2
  84. /* mapping command names to cmd chars - see datasheet */
  85. #define BLM_GO_RGB 0
  86. #define BLM_FADE_RGB 1
  87. #define BLM_FADE_HSB 2
  88. #define BLM_FADE_RAND_RGB 3
  89. #define BLM_FADE_RAND_HSB 4
  90. #define BLM_PLAY_SCRIPT 5
  91. #define BLM_STOP_SCRIPT 6
  92. #define BLM_SET_FADE_SPEED 7
  93. #define BLM_SET_TIME_ADJ 8
  94. #define BLM_GET_CUR_RGB 9
  95. #define BLM_WRITE_SCRIPT_LINE 10
  96. #define BLM_READ_SCRIPT_LINE 11
  97. #define BLM_SET_SCRIPT_LR 12 /* Length & Repeats */
  98. #define BLM_SET_ADDR 13
  99. #define BLM_GET_ADDR 14
  100. #define BLM_GET_FW_VER 15
  101. #define BLM_SET_STARTUP_PARAM 16
  102. /* BlinkM Commands
  103. * as extracted out of the datasheet:
  104. *
  105. * cmdchar = command (ascii)
  106. * cmdbyte = command in hex
  107. * nr_args = number of arguments (to send)
  108. * nr_ret = number of return values (to read)
  109. * dir = direction (0 = read, 1 = write, 2 = both)
  110. *
  111. */
  112. static const struct {
  113. char cmdchar;
  114. u8 cmdbyte;
  115. u8 nr_args;
  116. u8 nr_ret;
  117. u8 dir:2;
  118. } blinkm_cmds[17] = {
  119. /* cmdchar, cmdbyte, nr_args, nr_ret, dir */
  120. { 'n', 0x6e, 3, 0, 1},
  121. { 'c', 0x63, 3, 0, 1},
  122. { 'h', 0x68, 3, 0, 1},
  123. { 'C', 0x43, 3, 0, 1},
  124. { 'H', 0x48, 3, 0, 1},
  125. { 'p', 0x70, 3, 0, 1},
  126. { 'o', 0x6f, 0, 0, 1},
  127. { 'f', 0x66, 1, 0, 1},
  128. { 't', 0x74, 1, 0, 1},
  129. { 'g', 0x67, 0, 3, 0},
  130. { 'W', 0x57, 7, 0, 1},
  131. { 'R', 0x52, 2, 5, 2},
  132. { 'L', 0x4c, 3, 0, 1},
  133. { 'A', 0x41, 4, 0, 1},
  134. { 'a', 0x61, 0, 1, 0},
  135. { 'Z', 0x5a, 0, 1, 0},
  136. { 'B', 0x42, 5, 0, 1},
  137. };
  138. static ssize_t show_color_common(struct device *dev, char *buf, int color)
  139. {
  140. struct i2c_client *client;
  141. struct blinkm_data *data;
  142. int ret;
  143. client = to_i2c_client(dev);
  144. data = i2c_get_clientdata(client);
  145. ret = blinkm_transfer_hw(client, BLM_GET_CUR_RGB);
  146. if (ret < 0)
  147. return ret;
  148. switch (color) {
  149. case RED:
  150. return scnprintf(buf, PAGE_SIZE, "%02X\n", data->red);
  151. break;
  152. case GREEN:
  153. return scnprintf(buf, PAGE_SIZE, "%02X\n", data->green);
  154. break;
  155. case BLUE:
  156. return scnprintf(buf, PAGE_SIZE, "%02X\n", data->blue);
  157. break;
  158. default:
  159. return -EINVAL;
  160. }
  161. return -EINVAL;
  162. }
  163. static int store_color_common(struct device *dev, const char *buf, int color)
  164. {
  165. struct i2c_client *client;
  166. struct blinkm_data *data;
  167. int ret;
  168. u8 value;
  169. client = to_i2c_client(dev);
  170. data = i2c_get_clientdata(client);
  171. ret = kstrtou8(buf, 10, &value);
  172. if (ret < 0) {
  173. dev_err(dev, "BlinkM: value too large!\n");
  174. return ret;
  175. }
  176. switch (color) {
  177. case RED:
  178. data->next_red = value;
  179. break;
  180. case GREEN:
  181. data->next_green = value;
  182. break;
  183. case BLUE:
  184. data->next_blue = value;
  185. break;
  186. default:
  187. return -EINVAL;
  188. }
  189. dev_dbg(dev, "next_red = %d, next_green = %d, next_blue = %d\n",
  190. data->next_red, data->next_green, data->next_blue);
  191. /* if mode ... */
  192. ret = blinkm_transfer_hw(client, BLM_GO_RGB);
  193. if (ret < 0) {
  194. dev_err(dev, "BlinkM: can't set RGB\n");
  195. return ret;
  196. }
  197. return 0;
  198. }
  199. static ssize_t show_red(struct device *dev, struct device_attribute *attr,
  200. char *buf)
  201. {
  202. return show_color_common(dev, buf, RED);
  203. }
  204. static ssize_t store_red(struct device *dev, struct device_attribute *attr,
  205. const char *buf, size_t count)
  206. {
  207. int ret;
  208. ret = store_color_common(dev, buf, RED);
  209. if (ret < 0)
  210. return ret;
  211. return count;
  212. }
  213. static DEVICE_ATTR(red, S_IRUGO | S_IWUSR, show_red, store_red);
  214. static ssize_t show_green(struct device *dev, struct device_attribute *attr,
  215. char *buf)
  216. {
  217. return show_color_common(dev, buf, GREEN);
  218. }
  219. static ssize_t store_green(struct device *dev, struct device_attribute *attr,
  220. const char *buf, size_t count)
  221. {
  222. int ret;
  223. ret = store_color_common(dev, buf, GREEN);
  224. if (ret < 0)
  225. return ret;
  226. return count;
  227. }
  228. static DEVICE_ATTR(green, S_IRUGO | S_IWUSR, show_green, store_green);
  229. static ssize_t show_blue(struct device *dev, struct device_attribute *attr,
  230. char *buf)
  231. {
  232. return show_color_common(dev, buf, BLUE);
  233. }
  234. static ssize_t store_blue(struct device *dev, struct device_attribute *attr,
  235. const char *buf, size_t count)
  236. {
  237. int ret;
  238. ret = store_color_common(dev, buf, BLUE);
  239. if (ret < 0)
  240. return ret;
  241. return count;
  242. }
  243. static DEVICE_ATTR(blue, S_IRUGO | S_IWUSR, show_blue, store_blue);
  244. static ssize_t show_test(struct device *dev, struct device_attribute *attr,
  245. char *buf)
  246. {
  247. return scnprintf(buf, PAGE_SIZE,
  248. "#Write into test to start test sequence!#\n");
  249. }
  250. static ssize_t store_test(struct device *dev, struct device_attribute *attr,
  251. const char *buf, size_t count)
  252. {
  253. struct i2c_client *client;
  254. int ret;
  255. client = to_i2c_client(dev);
  256. /*test */
  257. ret = blinkm_test_run(client);
  258. if (ret < 0)
  259. return ret;
  260. return count;
  261. }
  262. static DEVICE_ATTR(test, S_IRUGO | S_IWUSR, show_test, store_test);
  263. /* TODO: HSB, fade, timeadj, script ... */
  264. static struct attribute *blinkm_attrs[] = {
  265. &dev_attr_red.attr,
  266. &dev_attr_green.attr,
  267. &dev_attr_blue.attr,
  268. &dev_attr_test.attr,
  269. NULL,
  270. };
  271. static struct attribute_group blinkm_group = {
  272. .name = "blinkm",
  273. .attrs = blinkm_attrs,
  274. };
  275. static int blinkm_write(struct i2c_client *client, int cmd, u8 *arg)
  276. {
  277. int result;
  278. int i;
  279. int arglen = blinkm_cmds[cmd].nr_args;
  280. /* write out cmd to blinkm - always / default step */
  281. result = i2c_smbus_write_byte(client, blinkm_cmds[cmd].cmdbyte);
  282. if (result < 0)
  283. return result;
  284. /* no args to write out */
  285. if (arglen == 0)
  286. return 0;
  287. for (i = 0; i < arglen; i++) {
  288. /* repeat for arglen */
  289. result = i2c_smbus_write_byte(client, arg[i]);
  290. if (result < 0)
  291. return result;
  292. }
  293. return 0;
  294. }
  295. static int blinkm_read(struct i2c_client *client, int cmd, u8 *arg)
  296. {
  297. int result;
  298. int i;
  299. int retlen = blinkm_cmds[cmd].nr_ret;
  300. for (i = 0; i < retlen; i++) {
  301. /* repeat for retlen */
  302. result = i2c_smbus_read_byte(client);
  303. if (result < 0)
  304. return result;
  305. arg[i] = result;
  306. }
  307. return 0;
  308. }
  309. static int blinkm_transfer_hw(struct i2c_client *client, int cmd)
  310. {
  311. /* the protocol is simple but non-standard:
  312. * e.g. cmd 'g' (= 0x67) for "get device address"
  313. * - which defaults to 0x09 - would be the sequence:
  314. * a) write 0x67 to the device (byte write)
  315. * b) read the value (0x09) back right after (byte read)
  316. *
  317. * Watch out for "unfinished" sequences (i.e. not enough reads
  318. * or writes after a command. It will make the blinkM misbehave.
  319. * Sequence is key here.
  320. */
  321. /* args / return are in private data struct */
  322. struct blinkm_data *data = i2c_get_clientdata(client);
  323. /* We start hardware transfers which are not to be
  324. * mixed with other commands. Aquire a lock now. */
  325. if (mutex_lock_interruptible(&data->update_lock) < 0)
  326. return -EAGAIN;
  327. /* switch cmd - usually write before reads */
  328. switch (cmd) {
  329. case BLM_FADE_RAND_RGB:
  330. case BLM_GO_RGB:
  331. case BLM_FADE_RGB:
  332. data->args[0] = data->next_red;
  333. data->args[1] = data->next_green;
  334. data->args[2] = data->next_blue;
  335. blinkm_write(client, cmd, data->args);
  336. data->red = data->args[0];
  337. data->green = data->args[1];
  338. data->blue = data->args[2];
  339. break;
  340. case BLM_FADE_HSB:
  341. case BLM_FADE_RAND_HSB:
  342. data->args[0] = data->next_hue;
  343. data->args[1] = data->next_saturation;
  344. data->args[2] = data->next_brightness;
  345. blinkm_write(client, cmd, data->args);
  346. data->hue = data->next_hue;
  347. data->saturation = data->next_saturation;
  348. data->brightness = data->next_brightness;
  349. break;
  350. case BLM_PLAY_SCRIPT:
  351. data->args[0] = data->script_id;
  352. data->args[1] = data->script_repeats;
  353. data->args[2] = data->script_startline;
  354. blinkm_write(client, cmd, data->args);
  355. break;
  356. case BLM_STOP_SCRIPT:
  357. blinkm_write(client, cmd, NULL);
  358. break;
  359. case BLM_GET_CUR_RGB:
  360. data->args[0] = data->red;
  361. data->args[1] = data->green;
  362. data->args[2] = data->blue;
  363. blinkm_write(client, cmd, NULL);
  364. blinkm_read(client, cmd, data->args);
  365. data->red = data->args[0];
  366. data->green = data->args[1];
  367. data->blue = data->args[2];
  368. break;
  369. case BLM_GET_ADDR:
  370. data->args[0] = data->i2c_addr;
  371. blinkm_write(client, cmd, NULL);
  372. blinkm_read(client, cmd, data->args);
  373. data->i2c_addr = data->args[0];
  374. break;
  375. case BLM_SET_TIME_ADJ:
  376. case BLM_SET_FADE_SPEED:
  377. case BLM_READ_SCRIPT_LINE:
  378. case BLM_WRITE_SCRIPT_LINE:
  379. case BLM_SET_SCRIPT_LR:
  380. case BLM_SET_ADDR:
  381. case BLM_GET_FW_VER:
  382. case BLM_SET_STARTUP_PARAM:
  383. dev_err(&client->dev,
  384. "BlinkM: cmd %d not implemented yet.\n", cmd);
  385. break;
  386. default:
  387. dev_err(&client->dev, "BlinkM: unknown command %d\n", cmd);
  388. mutex_unlock(&data->update_lock);
  389. return -EINVAL;
  390. } /* end switch(cmd) */
  391. /* transfers done, unlock */
  392. mutex_unlock(&data->update_lock);
  393. return 0;
  394. }
  395. static void led_work(struct work_struct *work)
  396. {
  397. int ret;
  398. struct blinkm_led *led;
  399. struct blinkm_data *data ;
  400. struct blinkm_work *blm_work = work_to_blmwork(work);
  401. led = blm_work->blinkm_led;
  402. data = i2c_get_clientdata(led->i2c_client);
  403. ret = blinkm_transfer_hw(led->i2c_client, BLM_GO_RGB);
  404. atomic_dec(&led->active);
  405. dev_dbg(&led->i2c_client->dev,
  406. "# DONE # next_red = %d, next_green = %d,"
  407. " next_blue = %d, active = %d\n",
  408. data->next_red, data->next_green,
  409. data->next_blue, atomic_read(&led->active));
  410. kfree(blm_work);
  411. }
  412. static int blinkm_led_common_set(struct led_classdev *led_cdev,
  413. enum led_brightness value, int color)
  414. {
  415. /* led_brightness is 0, 127 or 255 - we just use it here as-is */
  416. struct blinkm_led *led = cdev_to_blmled(led_cdev);
  417. struct blinkm_data *data = i2c_get_clientdata(led->i2c_client);
  418. struct blinkm_work *bl_work;
  419. switch (color) {
  420. case RED:
  421. /* bail out if there's no change */
  422. if (data->next_red == (u8) value)
  423. return 0;
  424. /* we assume a quite fast sequence here ([off]->on->off)
  425. * think of network led trigger - we cannot blink that fast, so
  426. * in case we already have a off->on->off transition queued up,
  427. * we refuse to queue up more.
  428. * Revisit: fast-changing brightness. */
  429. if (atomic_read(&led->active) > 1)
  430. return 0;
  431. data->next_red = (u8) value;
  432. break;
  433. case GREEN:
  434. /* bail out if there's no change */
  435. if (data->next_green == (u8) value)
  436. return 0;
  437. /* we assume a quite fast sequence here ([off]->on->off)
  438. * Revisit: fast-changing brightness. */
  439. if (atomic_read(&led->active) > 1)
  440. return 0;
  441. data->next_green = (u8) value;
  442. break;
  443. case BLUE:
  444. /* bail out if there's no change */
  445. if (data->next_blue == (u8) value)
  446. return 0;
  447. /* we assume a quite fast sequence here ([off]->on->off)
  448. * Revisit: fast-changing brightness. */
  449. if (atomic_read(&led->active) > 1)
  450. return 0;
  451. data->next_blue = (u8) value;
  452. break;
  453. default:
  454. dev_err(&led->i2c_client->dev, "BlinkM: unknown color.\n");
  455. return -EINVAL;
  456. }
  457. bl_work = kzalloc(sizeof(*bl_work), GFP_ATOMIC);
  458. if (!bl_work)
  459. return -ENOMEM;
  460. atomic_inc(&led->active);
  461. dev_dbg(&led->i2c_client->dev,
  462. "#TO_SCHED# next_red = %d, next_green = %d,"
  463. " next_blue = %d, active = %d\n",
  464. data->next_red, data->next_green,
  465. data->next_blue, atomic_read(&led->active));
  466. /* a fresh work _item_ for each change */
  467. bl_work->blinkm_led = led;
  468. INIT_WORK(&bl_work->work, led_work);
  469. /* queue work in own queue for easy sync on exit*/
  470. schedule_work(&bl_work->work);
  471. return 0;
  472. }
  473. static void blinkm_led_red_set(struct led_classdev *led_cdev,
  474. enum led_brightness value)
  475. {
  476. blinkm_led_common_set(led_cdev, value, RED);
  477. }
  478. static void blinkm_led_green_set(struct led_classdev *led_cdev,
  479. enum led_brightness value)
  480. {
  481. blinkm_led_common_set(led_cdev, value, GREEN);
  482. }
  483. static void blinkm_led_blue_set(struct led_classdev *led_cdev,
  484. enum led_brightness value)
  485. {
  486. blinkm_led_common_set(led_cdev, value, BLUE);
  487. }
  488. static void blinkm_init_hw(struct i2c_client *client)
  489. {
  490. int ret;
  491. ret = blinkm_transfer_hw(client, BLM_STOP_SCRIPT);
  492. ret = blinkm_transfer_hw(client, BLM_GO_RGB);
  493. }
  494. static int blinkm_test_run(struct i2c_client *client)
  495. {
  496. int ret;
  497. struct blinkm_data *data = i2c_get_clientdata(client);
  498. data->next_red = 0x01;
  499. data->next_green = 0x05;
  500. data->next_blue = 0x10;
  501. ret = blinkm_transfer_hw(client, BLM_GO_RGB);
  502. if (ret < 0)
  503. return ret;
  504. msleep(2000);
  505. data->next_red = 0x25;
  506. data->next_green = 0x10;
  507. data->next_blue = 0x31;
  508. ret = blinkm_transfer_hw(client, BLM_FADE_RGB);
  509. if (ret < 0)
  510. return ret;
  511. msleep(2000);
  512. data->next_hue = 0x50;
  513. data->next_saturation = 0x10;
  514. data->next_brightness = 0x20;
  515. ret = blinkm_transfer_hw(client, BLM_FADE_HSB);
  516. if (ret < 0)
  517. return ret;
  518. msleep(2000);
  519. return 0;
  520. }
  521. /* Return 0 if detection is successful, -ENODEV otherwise */
  522. static int blinkm_detect(struct i2c_client *client, struct i2c_board_info *info)
  523. {
  524. struct i2c_adapter *adapter = client->adapter;
  525. int ret;
  526. int count = 99;
  527. u8 tmpargs[7];
  528. if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA
  529. | I2C_FUNC_SMBUS_WORD_DATA
  530. | I2C_FUNC_SMBUS_WRITE_BYTE))
  531. return -ENODEV;
  532. /* Now, we do the remaining detection. Simple for now. */
  533. /* We might need more guards to protect other i2c slaves */
  534. /* make sure the blinkM is balanced (read/writes) */
  535. while (count > 0) {
  536. ret = blinkm_write(client, BLM_GET_ADDR, NULL);
  537. usleep_range(5000, 10000);
  538. ret = blinkm_read(client, BLM_GET_ADDR, tmpargs);
  539. usleep_range(5000, 10000);
  540. if (tmpargs[0] == 0x09)
  541. count = 0;
  542. count--;
  543. }
  544. /* Step 1: Read BlinkM address back - cmd_char 'a' */
  545. ret = blinkm_write(client, BLM_GET_ADDR, NULL);
  546. if (ret < 0)
  547. return ret;
  548. usleep_range(20000, 30000); /* allow a small delay */
  549. ret = blinkm_read(client, BLM_GET_ADDR, tmpargs);
  550. if (ret < 0)
  551. return ret;
  552. if (tmpargs[0] != 0x09) {
  553. dev_err(&client->dev, "enodev DEV ADDR = 0x%02X\n", tmpargs[0]);
  554. return -ENODEV;
  555. }
  556. strlcpy(info->type, "blinkm", I2C_NAME_SIZE);
  557. return 0;
  558. }
  559. static int blinkm_probe(struct i2c_client *client,
  560. const struct i2c_device_id *id)
  561. {
  562. struct blinkm_data *data;
  563. struct blinkm_led *led[3];
  564. int err, i;
  565. char blinkm_led_name[28];
  566. data = devm_kzalloc(&client->dev,
  567. sizeof(struct blinkm_data), GFP_KERNEL);
  568. if (!data) {
  569. err = -ENOMEM;
  570. goto exit;
  571. }
  572. data->i2c_addr = 0x09;
  573. data->i2c_addr = 0x08;
  574. /* i2c addr - use fake addr of 0x08 initially (real is 0x09) */
  575. data->fw_ver = 0xfe;
  576. /* firmware version - use fake until we read real value
  577. * (currently broken - BlinkM confused!) */
  578. data->script_id = 0x01;
  579. data->i2c_client = client;
  580. i2c_set_clientdata(client, data);
  581. mutex_init(&data->update_lock);
  582. /* Register sysfs hooks */
  583. err = sysfs_create_group(&client->dev.kobj, &blinkm_group);
  584. if (err < 0) {
  585. dev_err(&client->dev, "couldn't register sysfs group\n");
  586. goto exit;
  587. }
  588. for (i = 0; i < 3; i++) {
  589. /* RED = 0, GREEN = 1, BLUE = 2 */
  590. led[i] = &data->blinkm_leds[i];
  591. led[i]->i2c_client = client;
  592. led[i]->id = i;
  593. led[i]->led_cdev.max_brightness = 255;
  594. led[i]->led_cdev.flags = LED_CORE_SUSPENDRESUME;
  595. atomic_set(&led[i]->active, 0);
  596. switch (i) {
  597. case RED:
  598. snprintf(blinkm_led_name, sizeof(blinkm_led_name),
  599. "blinkm-%d-%d-red",
  600. client->adapter->nr,
  601. client->addr);
  602. led[i]->led_cdev.name = blinkm_led_name;
  603. led[i]->led_cdev.brightness_set = blinkm_led_red_set;
  604. err = led_classdev_register(&client->dev,
  605. &led[i]->led_cdev);
  606. if (err < 0) {
  607. dev_err(&client->dev,
  608. "couldn't register LED %s\n",
  609. led[i]->led_cdev.name);
  610. goto failred;
  611. }
  612. break;
  613. case GREEN:
  614. snprintf(blinkm_led_name, sizeof(blinkm_led_name),
  615. "blinkm-%d-%d-green",
  616. client->adapter->nr,
  617. client->addr);
  618. led[i]->led_cdev.name = blinkm_led_name;
  619. led[i]->led_cdev.brightness_set = blinkm_led_green_set;
  620. err = led_classdev_register(&client->dev,
  621. &led[i]->led_cdev);
  622. if (err < 0) {
  623. dev_err(&client->dev,
  624. "couldn't register LED %s\n",
  625. led[i]->led_cdev.name);
  626. goto failgreen;
  627. }
  628. break;
  629. case BLUE:
  630. snprintf(blinkm_led_name, sizeof(blinkm_led_name),
  631. "blinkm-%d-%d-blue",
  632. client->adapter->nr,
  633. client->addr);
  634. led[i]->led_cdev.name = blinkm_led_name;
  635. led[i]->led_cdev.brightness_set = blinkm_led_blue_set;
  636. err = led_classdev_register(&client->dev,
  637. &led[i]->led_cdev);
  638. if (err < 0) {
  639. dev_err(&client->dev,
  640. "couldn't register LED %s\n",
  641. led[i]->led_cdev.name);
  642. goto failblue;
  643. }
  644. break;
  645. } /* end switch */
  646. } /* end for */
  647. /* Initialize the blinkm */
  648. blinkm_init_hw(client);
  649. return 0;
  650. failblue:
  651. led_classdev_unregister(&led[GREEN]->led_cdev);
  652. failgreen:
  653. led_classdev_unregister(&led[RED]->led_cdev);
  654. failred:
  655. sysfs_remove_group(&client->dev.kobj, &blinkm_group);
  656. exit:
  657. return err;
  658. }
  659. static int blinkm_remove(struct i2c_client *client)
  660. {
  661. struct blinkm_data *data = i2c_get_clientdata(client);
  662. int ret = 0;
  663. int i;
  664. /* make sure no workqueue entries are pending */
  665. for (i = 0; i < 3; i++) {
  666. flush_scheduled_work();
  667. led_classdev_unregister(&data->blinkm_leds[i].led_cdev);
  668. }
  669. /* reset rgb */
  670. data->next_red = 0x00;
  671. data->next_green = 0x00;
  672. data->next_blue = 0x00;
  673. ret = blinkm_transfer_hw(client, BLM_FADE_RGB);
  674. if (ret < 0)
  675. dev_err(&client->dev, "Failure in blinkm_remove ignored. Continuing.\n");
  676. /* reset hsb */
  677. data->next_hue = 0x00;
  678. data->next_saturation = 0x00;
  679. data->next_brightness = 0x00;
  680. ret = blinkm_transfer_hw(client, BLM_FADE_HSB);
  681. if (ret < 0)
  682. dev_err(&client->dev, "Failure in blinkm_remove ignored. Continuing.\n");
  683. /* red fade to off */
  684. data->next_red = 0xff;
  685. ret = blinkm_transfer_hw(client, BLM_GO_RGB);
  686. if (ret < 0)
  687. dev_err(&client->dev, "Failure in blinkm_remove ignored. Continuing.\n");
  688. /* off */
  689. data->next_red = 0x00;
  690. ret = blinkm_transfer_hw(client, BLM_FADE_RGB);
  691. if (ret < 0)
  692. dev_err(&client->dev, "Failure in blinkm_remove ignored. Continuing.\n");
  693. sysfs_remove_group(&client->dev.kobj, &blinkm_group);
  694. return 0;
  695. }
  696. static const struct i2c_device_id blinkm_id[] = {
  697. {"blinkm", 0},
  698. {}
  699. };
  700. MODULE_DEVICE_TABLE(i2c, blinkm_id);
  701. /* This is the driver that will be inserted */
  702. static struct i2c_driver blinkm_driver = {
  703. .class = I2C_CLASS_HWMON,
  704. .driver = {
  705. .name = "blinkm",
  706. },
  707. .probe = blinkm_probe,
  708. .remove = blinkm_remove,
  709. .id_table = blinkm_id,
  710. .detect = blinkm_detect,
  711. .address_list = normal_i2c,
  712. };
  713. module_i2c_driver(blinkm_driver);
  714. MODULE_AUTHOR("Jan-Simon Moeller <dl9pf@gmx.de>");
  715. MODULE_DESCRIPTION("BlinkM RGB LED driver");
  716. MODULE_LICENSE("GPL");