]> www.pilppa.org Git - linux-2.6-omap-h63xx.git/blob - drivers/input/keyboard/lm8323.c
72bb587eb035adca819363047f527c62baa1c915
[linux-2.6-omap-h63xx.git] / drivers / input / keyboard / lm8323.c
1 /*
2  * drivers/i2c/chips/lm8323.c
3  *
4  * Copyright (C) 2007 Nokia Corporation
5  *
6  * Written by Daniel Stone <daniel.stone@nokia.com>
7  *            Timo O. Karjalainen <timo.o.karjalainen@nokia.com>
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License as published by
11  * the Free Software Foundation (version 2 of the License only).
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21  */
22
23 #include <linux/module.h>
24 #include <linux/i2c.h>
25 #include <linux/interrupt.h>
26 #include <linux/sched.h>
27 #include <linux/mutex.h>
28 #include <linux/delay.h>
29 #include <linux/input.h>
30 #include <linux/leds.h>
31 #include <linux/i2c/lm8323.h>
32
33 #include <asm/mach-types.h>
34 #include <asm/mach/irq.h>
35
36 #ifdef VERBOSE
37 #define debug dev_dbg
38 #else
39 #define debug(...)
40 #endif
41
42 /* Commands to send to the chip. */
43 #define LM8323_CMD_READ_ID              0x80 /* Read chip ID. */
44 #define LM8323_CMD_WRITE_CFG            0x81 /* Set configuration item. */
45 #define LM8323_CMD_READ_INT             0x82 /* Get interrupt status. */
46 #define LM8323_CMD_RESET                0x83 /* Reset, same as external one */
47 #define LM8323_CMD_WRITE_PORT_SEL       0x85 /* Set GPIO in/out. */
48 #define LM8323_CMD_WRITE_PORT_STATE     0x86 /* Set GPIO pullup. */
49 #define LM8323_CMD_READ_PORT_SEL        0x87 /* Get GPIO in/out. */
50 #define LM8323_CMD_READ_PORT_STATE      0x88 /* Get GPIO pullup. */
51 #define LM8323_CMD_READ_FIFO            0x89 /* Read byte from FIFO. */
52 #define LM8323_CMD_RPT_READ_FIFO        0x8a /* Read FIFO (no increment). */
53 #define LM8323_CMD_SET_ACTIVE           0x8b /* Set active time. */
54 #define LM8323_CMD_READ_ERR             0x8c /* Get error status. */
55 #define LM8323_CMD_READ_ROTATOR         0x8e /* Read rotator status. */
56 #define LM8323_CMD_SET_DEBOUNCE         0x8f /* Set debouncing time. */
57 #define LM8323_CMD_SET_KEY_SIZE         0x90 /* Set keypad size. */
58 #define LM8323_CMD_READ_KEY_SIZE        0x91 /* Get keypad size. */
59 #define LM8323_CMD_READ_CFG             0x92 /* Get configuration item. */
60 #define LM8323_CMD_WRITE_CLOCK          0x93 /* Set clock config. */
61 #define LM8323_CMD_READ_CLOCK           0x94 /* Get clock config. */
62 #define LM8323_CMD_PWM_WRITE            0x95 /* Write PWM script. */
63 #define LM8323_CMD_START_PWM            0x96 /* Start PWM engine. */
64 #define LM8323_CMD_STOP_PWM             0x97 /* Stop PWM engine. */
65
66 /* Interrupt status. */
67 #define INT_KEYPAD                      0x01 /* Key event. */
68 #define INT_ROTATOR                     0x02 /* Rotator event. */
69 #define INT_ERROR                       0x08 /* Error: use CMD_READ_ERR. */
70 #define INT_NOINIT                      0x10 /* Lost configuration. */
71 #define INT_PWM1                        0x20 /* PWM1 stopped. */
72 #define INT_PWM2                        0x40 /* PWM2 stopped. */
73 #define INT_PWM3                        0x80 /* PWM3 stopped. */
74
75 /* Errors (signalled by INT_ERROR, read with CMD_READ_ERR). */
76 #define ERR_BADPAR                      0x01 /* Bad parameter. */
77 #define ERR_CMDUNK                      0x02 /* Unknown command. */
78 #define ERR_KEYOVR                      0x04 /* Too many keys pressed. */
79 #define ERR_FIFOOVER                    0x40 /* FIFO overflow. */
80
81 /* Configuration keys (CMD_{WRITE,READ}_CFG). */
82 #define CFG_MUX1SEL                     0x01 /* Select MUX1_OUT input. */
83 #define CFG_MUX1EN                      0x02 /* Enable MUX1_OUT. */
84 #define CFG_MUX2SEL                     0x04 /* Select MUX2_OUT input. */
85 #define CFG_MUX2EN                      0x08 /* Enable MUX2_OUT. */
86 #define CFG_PSIZE                       0x20 /* Package size (must be 0). */
87 #define CFG_ROTEN                       0x40 /* Enable rotator. */
88
89 /* Clock settings (CMD_{WRITE,READ}_CLOCK). */
90 #define CLK_RCPWM_INTERNAL              0x00
91 #define CLK_RCPWM_EXTERNAL              0x03
92 #define CLK_SLOWCLKEN                   0x08 /* Enable 32.768kHz clock. */
93 #define CLK_SLOWCLKOUT                  0x40 /* Enable slow pulse output. */
94
95 /* The possible addresses corresponding to CONFIG1 and CONFIG2 pin wirings. */
96 #define LM8323_I2C_ADDR00               (0x84 >> 1)     /* 1000 010x */
97 #define LM8323_I2C_ADDR01               (0x86 >> 1)     /* 1000 011x */
98 #define LM8323_I2C_ADDR10               (0x88 >> 1)     /* 1000 100x */
99 #define LM8323_I2C_ADDR11               (0x8A >> 1)     /* 1000 101x */
100
101 /* Key event fifo length */
102 #define LM8323_FIFO_LEN                 15
103
104 /* Commands for PWM engine; feed in with PWM_WRITE. */
105 /* Load ramp counter from duty cycle field (range 0 - 0xff). */
106 #define PWM_SET(v)                      (0x4000 | ((v) & 0xff))
107 /* Go to start of script. */
108 #define PWM_GOTOSTART                   0x0000
109 /*
110  * Stop engine (generates interrupt).  If reset is 1, clear the program
111  * counter, else leave it.
112  */
113 #define PWM_END(reset)                  (0xc000 | (!!(reset) << 11))
114 /*
115  * Ramp.  If s is 1, divide clock by 512, else divide clock by 16.
116  * Take t clock scales (up to 63) per step, for n steps (up to 126).
117  * If u is set, ramp up, else ramp down.
118  */
119 #define PWM_RAMP(s, t, n, u)            ((!!(s) << 14) | ((t) & 0x3f) << 8 | \
120                                          ((n) & 0x7f) | ((u) ? 0 : 0x80))
121 /*
122  * Loop (i.e. jump back to pos) for a given number of iterations (up to 63).
123  * If cnt is zero, execute until PWM_END is encountered.
124  */
125 #define PWM_LOOP(cnt, pos)              (0xa000 | (((cnt) & 0x3f) << 7) | \
126                                          ((pos) & 0x3f))
127 /*
128  * Wait for trigger.  Argument is a mask of channels, shifted by the channel
129  * number, e.g. 0xa for channels 3 and 1.  Note that channels are numbered
130  * from 1, not 0.
131  */
132 #define PWM_WAIT_TRIG(chans)            (0xe000 | (((chans) & 0x7) << 6))
133 /* Send trigger.  Argument is same as PWM_WAIT_TRIG. */
134 #define PWM_SEND_TRIG(chans)            (0xe000 | ((chans) & 0x7))
135
136 #define DRIVER_NAME  "lm8323"
137
138 struct lm8323_pwm {
139         int                     id;
140         int                     enabled;
141         int                     fade_time;
142         int                     brightness;
143         int                     desired_brightness;
144         struct work_struct      work;
145         struct led_classdev     cdev;
146 };
147
148 struct lm8323_chip {
149         struct mutex            lock;
150         struct i2c_client       *client;
151         struct work_struct      work;
152         struct input_dev        *idev;
153         unsigned                kp_enabled : 1;
154         unsigned                pm_suspend : 1;
155         unsigned                keys_down;
156         char                    phys[32];
157         s16                     keymap[LM8323_KEYMAP_SIZE];
158         int                     size_x;
159         int                     size_y;
160         int                     debounce_time;
161         int                     active_time;
162         struct lm8323_pwm       pwm1;
163         struct lm8323_pwm       pwm2;
164         struct lm8323_pwm       pwm3;
165 };
166
167 #define client_to_lm8323(c)     container_of(c, struct lm8323_chip, client)
168 #define dev_to_lm8323(d)        container_of(d, struct lm8323_chip, client->dev)
169 #define work_to_lm8323(w)       container_of(w, struct lm8323_chip, work)
170 #define cdev_to_pwm(c)          container_of(c, struct lm8323_pwm, cdev)
171 #define work_to_pwm(w)          container_of(w, struct lm8323_pwm, work)
172
173 static struct lm8323_chip *pwm_to_lm8323(struct lm8323_pwm *pwm)
174 {
175         switch (pwm->id) {
176         case 1:
177                 return container_of(pwm, struct lm8323_chip, pwm1);
178         case 2:
179                 return container_of(pwm, struct lm8323_chip, pwm2);
180         case 3:
181                 return container_of(pwm, struct lm8323_chip, pwm3);
182         default:
183                 return NULL;
184         }
185 }
186
187 static struct lm8323_platform_data *lm8323_pdata;
188
189
190 #define LM8323_MAX_DATA 8
191
192 /*
193  * To write, we just access the chip's address in write mode, and dump the
194  * command and data out on the bus.  The command byte and data are taken as
195  * sequential u8s out of varargs, to a maximum of LM8323_MAX_DATA.
196  */
197 static int lm8323_write(struct lm8323_chip *lm, int len, ...)
198 {
199         int ret, i;
200         va_list ap;
201         u8 data[LM8323_MAX_DATA];
202
203         va_start(ap, len);
204
205         if (unlikely(len > LM8323_MAX_DATA)) {
206                 dev_err(&lm->client->dev, "tried to send %d bytes\n", len);
207                 va_end(ap);
208                 return 0;
209         }
210
211         for (i = 0; i < len; i++)
212                 data[i] = va_arg(ap, int);
213
214         va_end(ap);
215
216         /*
217          * If the host is asleep while we send the data, we can get a NACK
218          * back while it wakes up, so try again, once.
219          */
220         ret = i2c_master_send(lm->client, data, len);
221         if (unlikely(ret == -EREMOTEIO))
222                 ret = i2c_master_send(lm->client, data, len);
223         if (unlikely(ret != len))
224                 dev_err(&lm->client->dev, "sent %d bytes of %d total\n",
225                         len, ret);
226
227         return ret;
228 }
229
230 /*
231  * To read, we first send the command byte to the chip and end the transaction,
232  * then access the chip in read mode, at which point it will send the data.
233  */
234 static int lm8323_read(struct lm8323_chip *lm, u8 cmd, u8 *buf, int len)
235 {
236         int ret;
237
238         /*
239          * If the host is asleep while we send the byte, we can get a NACK
240          * back while it wakes up, so try again, once.
241          */
242         ret = i2c_master_send(lm->client, &cmd, 1);
243         if (unlikely(ret == -EREMOTEIO))
244                 ret = i2c_master_send(lm->client, &cmd, 1);
245         if (unlikely(ret != 1)) {
246                 dev_err(&lm->client->dev, "sending read cmd 0x%02x failed\n",
247                         cmd);
248                 return 0;
249         }
250
251         ret = i2c_master_recv(lm->client, buf, len);
252         if (unlikely(ret != len))
253                 dev_err(&lm->client->dev, "wanted %d bytes, got %d\n",
254                         len, ret);
255
256         return ret;
257 }
258
259 /*
260  * Set the chip active time (idle time before it enters halt).
261  */
262 static void lm8323_set_active_time(struct lm8323_chip *lm, int time)
263 {
264         lm8323_write(lm, 2, LM8323_CMD_SET_ACTIVE, time >> 2);
265 }
266
267 /*
268  * The signals are AT-style: the low 7 bits are the keycode, and the top
269  * bit indicates the state (1 for down, 0 for up).
270  */
271 static inline u8 lm8323_whichkey(u8 event)
272 {
273         return event & 0x7f;
274 }
275
276 static inline int lm8323_ispress(u8 event)
277 {
278         return (event & 0x80) ? 1 : 0;
279 }
280
281 static void process_keys(struct lm8323_chip *lm)
282 {
283         u8 event;
284         u8 key_fifo[LM8323_FIFO_LEN + 1];
285         int old_keys_down = lm->keys_down;
286         int ret;
287         int i = 0;
288
289         /*
290          * Read all key events from the FIFO at once. Next READ_FIFO clears the
291          * FIFO even if we didn't read all events previously.
292          */
293         ret = lm8323_read(lm, LM8323_CMD_READ_FIFO, key_fifo, LM8323_FIFO_LEN);
294
295         if (ret < 0) {
296                 dev_err(&lm->client->dev, "Failed reading fifo \n");
297                 return;
298         }
299         key_fifo[ret] = 0;
300
301         while ((event = key_fifo[i])) {
302                 u8 key = lm8323_whichkey(event);
303                 int isdown = lm8323_ispress(event);
304                 s16 keycode = lm->keymap[key];
305
306                 if (likely(keycode > 0)) {
307                         debug(&lm->client->dev, "key 0x%02x %s\n", key,
308                               isdown ? "down" : "up");
309                         if (likely(lm->kp_enabled)) {
310                                 input_report_key(lm->idev, keycode, isdown);
311                                 input_sync(lm->idev);
312                         }
313                         if (isdown)
314                                 lm->keys_down++;
315                         else
316                                 lm->keys_down--;
317                 } else {
318                         dev_err(&lm->client->dev, "keycode 0x%02x not mapped "
319                                 "to any key\n", key);
320                 }
321                 i++;
322         }
323
324         /*
325          * Errata: We need to ensure that the chip never enters halt mode
326          * during a keypress, so set active time to 0.  When it's released,
327          * we can enter halt again, so set the active time back to normal.
328          */
329         if (!old_keys_down && lm->keys_down)
330                 lm8323_set_active_time(lm, 0);
331         if (old_keys_down && !lm->keys_down)
332                 lm8323_set_active_time(lm, lm->active_time);
333 }
334
335 static void lm8323_process_error(struct lm8323_chip *lm)
336 {
337         u8 error;
338
339         if (lm8323_read(lm, LM8323_CMD_READ_ERR, &error, 1) == 1) {
340                 if (error & ERR_FIFOOVER)
341                         debug(&lm->client->dev, "fifo overflow!\n");
342                 if (error & ERR_KEYOVR)
343                         debug(&lm->client->dev, "more than two keys pressed\n");
344                 if (error & ERR_CMDUNK)
345                         debug(&lm->client->dev, "unknown command submitted\n");
346                 if (error & ERR_BADPAR)
347                         debug(&lm->client->dev, "bad command parameter\n");
348         }
349 }
350
351 static void lm8323_reset(struct lm8323_chip *lm)
352 {
353         /* The docs say we must pass 0xAA as the data byte. */
354         lm8323_write(lm, 2, LM8323_CMD_RESET, 0xAA);
355 }
356
357 static int lm8323_configure(struct lm8323_chip *lm)
358 {
359         int keysize = (lm->size_x << 4) | lm->size_y;
360         int clock = (CLK_SLOWCLKEN | CLK_RCPWM_EXTERNAL);
361         int debounce = lm->debounce_time >> 2;
362         int active = lm->active_time >> 2;
363
364         /*
365          * Active time must be greater than the debounce time: if it's
366          * a close-run thing, give ourselves a 12ms buffer.
367          */
368         if (debounce >= active)
369                 active = debounce + 3;
370
371         lm8323_write(lm, 2, LM8323_CMD_WRITE_CFG, 0);
372         lm8323_write(lm, 2, LM8323_CMD_WRITE_CLOCK, clock);
373         lm8323_write(lm, 2, LM8323_CMD_SET_KEY_SIZE, keysize);
374         lm8323_set_active_time(lm, lm->active_time);
375         lm8323_write(lm, 2, LM8323_CMD_SET_DEBOUNCE, debounce);
376         lm8323_write(lm, 3, LM8323_CMD_WRITE_PORT_STATE, 0xff, 0xff);
377         lm8323_write(lm, 3, LM8323_CMD_WRITE_PORT_SEL, 0, 0);
378
379         /*
380          * Not much we can do about errors at this point, so just hope
381          * for the best.
382          */
383
384         return 0;
385 }
386
387 /*
388  * Bottom half: handle the interrupt by posting key events, or dealing with
389  * errors appropriately.
390  */
391 static void lm8323_work(struct work_struct *work)
392 {
393         struct lm8323_chip *lm = work_to_lm8323(work);
394         u8 ints;
395
396         mutex_lock(&lm->lock);
397
398         while ((lm8323_read(lm, LM8323_CMD_READ_INT, &ints, 1) == 1) && ints) {
399                 if (likely(ints & INT_KEYPAD))
400                         process_keys(lm);
401                 if (ints & INT_ROTATOR) {
402                         /* We don't currently support the rotator. */
403                         debug(&lm->client->dev, "rotator fired\n");
404                 }
405                 if (ints & INT_ERROR) {
406                         debug(&lm->client->dev, "error!\n");
407                         lm8323_process_error(lm);
408                 }
409                 if (ints & INT_NOINIT) {
410                         dev_err(&lm->client->dev, "chip lost config; "
411                                                   "reinitialising\n");
412                         lm8323_configure(lm);
413                 }
414                 if (ints & INT_PWM1)
415                         debug(&lm->client->dev, "pwm1 engine completed\n");
416                 if (ints & INT_PWM2)
417                         debug(&lm->client->dev, "pwm2 engine completed\n");
418                 if (ints & INT_PWM3)
419                         debug(&lm->client->dev, "pwm3 engine completed\n");
420         }
421
422         mutex_unlock(&lm->lock);
423 }
424
425 /*
426  * We cannot use I2C in interrupt context, so we just schedule work.
427  */
428 static irqreturn_t lm8323_irq(int irq, void *data)
429 {
430         struct lm8323_chip *lm = data;
431
432         schedule_work(&lm->work);
433
434         return IRQ_HANDLED;
435 }
436
437 /*
438  * Read the chip ID.
439  */
440 static int lm8323_read_id(struct lm8323_chip *lm, u8 *buf)
441 {
442         int bytes;
443
444         bytes = lm8323_read(lm, LM8323_CMD_READ_ID, buf, 2);
445         if (unlikely(bytes != 2))
446                 return -EIO;
447
448         return 0;
449 }
450
451 static void lm8323_write_pwm_one(struct lm8323_pwm *pwm, int pos, u16 cmd)
452 {
453         struct lm8323_chip *lm = pwm_to_lm8323(pwm);
454
455         lm8323_write(lm, 4, LM8323_CMD_PWM_WRITE, (pos << 2) | pwm->id,
456                      (cmd & 0xff00) >> 8, cmd & 0x00ff);
457 }
458
459 /*
460  * Write a script into a given PWM engine, concluding with PWM_END.
461  * If 'keepalive' is specified, the engine will be kept running
462  * indefinitely.
463  */
464 static void lm8323_write_pwm(struct lm8323_pwm *pwm, int keepalive,
465                              int len, ...)
466 {
467         struct lm8323_chip *lm = pwm_to_lm8323(pwm);
468         int i, cmd;
469         va_list ap;
470
471         /*
472          * If there are any scripts running at the moment, terminate them
473          * and make sure the duty cycle is as if it finished.
474          */
475         lm8323_write(lm, 2, LM8323_CMD_STOP_PWM, pwm->id);
476
477         va_start(ap, len);
478         for (i = 0; i < len; i++) {
479                 cmd = va_arg(ap, int);
480                 lm8323_write_pwm_one(pwm, i, cmd);
481         }
482         va_end(ap);
483
484         /* Wait for a trigger from any channel. This keeps the engine alive. */
485         if (keepalive)
486                 lm8323_write_pwm_one(pwm, i++, PWM_WAIT_TRIG(0xe));
487         else
488                 lm8323_write_pwm_one(pwm, i++, PWM_END(1));
489
490         lm8323_write(lm, 2, LM8323_CMD_START_PWM, pwm->id);
491 }
492
493 static void lm8323_pwm_work(struct work_struct *work)
494 {
495         struct lm8323_pwm *pwm = work_to_pwm(work);
496         int div, perstep, steps, hz, direction, keepalive;
497
498         /* Do nothing if we're already at the requested level. */
499         if (pwm->desired_brightness == pwm->brightness)
500                 return;
501
502         keepalive = (pwm->desired_brightness > 0);
503         direction = (pwm->desired_brightness > pwm->brightness);
504         steps = abs(pwm->desired_brightness - pwm->brightness);
505
506         /*
507          * Convert time (in ms) into a divisor (512 or 16 on a refclk of
508          * 32768Hz), and number of ticks per step.
509          */
510         if ((pwm->fade_time / steps) > (32768 / 512))
511                 div = 512;
512         else
513                 div = 16;
514
515         hz = 32768 / div;
516         if (pwm->fade_time < ((steps * 1000) / hz))
517                 perstep = 1;
518         else
519                 perstep = (hz * pwm->fade_time) / (steps * 1000);
520
521         if (perstep == 0)
522                 perstep = 1;
523         else if (perstep > 63)
524                 perstep = 63;
525
526         if (steps > 252) {
527                 lm8323_write_pwm(pwm, keepalive, 3,
528                                  PWM_RAMP((div == 512), perstep, 126,
529                                           direction),
530                                  PWM_RAMP((div == 512), perstep, 126,
531                                           direction),
532                                  PWM_RAMP((div == 512), perstep, steps - 252,
533                                           direction));
534         } else if (steps > 126) {
535                 lm8323_write_pwm(pwm, keepalive, 2,
536                                  PWM_RAMP((div == 512), perstep, 126,
537                                           direction),
538                                  PWM_RAMP((div == 512), perstep, steps - 126,
539                                           direction));
540         } else {
541                 lm8323_write_pwm(pwm, keepalive, 1,
542                                  PWM_RAMP((div == 512), perstep, steps,
543                                           direction));
544         }
545
546         pwm->brightness = pwm->desired_brightness;
547 }
548
549 static void lm8323_pwm_set_brightness(struct led_classdev *led_cdev,
550                                       enum led_brightness brightness)
551 {
552         struct lm8323_pwm *pwm = cdev_to_pwm(led_cdev);
553         struct lm8323_chip *lm = pwm_to_lm8323(pwm);
554
555         pwm->desired_brightness = brightness;
556
557         if (in_interrupt()) {
558                 schedule_work(&pwm->work);
559         } else {
560                 /*
561                  * Schedule PWM work as usual unless we are going into suspend
562                  */
563                 mutex_lock(&lm->lock);
564                 if (likely(!lm->pm_suspend))
565                         schedule_work(&pwm->work);
566                 else
567                         lm8323_pwm_work(&pwm->work);
568                 mutex_unlock(&lm->lock);
569         }
570 }
571
572 static ssize_t lm8323_pwm_show_time(struct device *dev,
573                 struct device_attribute *attr, char *buf)
574 {
575         struct led_classdev *led_cdev = dev_get_drvdata(dev);
576         struct lm8323_pwm *pwm = cdev_to_pwm(led_cdev);
577
578         return sprintf(buf, "%d\n", pwm->fade_time);
579 }
580
581 static ssize_t lm8323_pwm_store_time(struct device *dev,
582                 struct device_attribute *attr, const char *buf, size_t len)
583 {
584         struct led_classdev *led_cdev = dev_get_drvdata(dev);
585         struct lm8323_pwm *pwm = cdev_to_pwm(led_cdev);
586         int ret;
587         int time;
588
589         ret = sscanf(buf, "%d", &time);
590         /* Numbers only, please. */
591         if (ret)
592                 return -EINVAL;
593
594         pwm->fade_time = time;
595
596         return strlen(buf);
597 }
598 static DEVICE_ATTR(time, 0644, lm8323_pwm_show_time, lm8323_pwm_store_time);
599
600 static int init_pwm(struct lm8323_chip *lm, int id, struct device *dev,
601                     const char *name)
602 {
603         struct lm8323_pwm *pwm = NULL;
604
605         BUG_ON(id > 3);
606
607         switch (id) {
608         case 1:
609                 pwm = &lm->pwm1;
610                 break;
611         case 2:
612                 pwm = &lm->pwm2;
613                 break;
614         case 3:
615                 pwm = &lm->pwm3;
616                 break;
617         }
618
619         pwm->id = id;
620         pwm->fade_time = 0;
621         pwm->brightness = 0;
622         pwm->desired_brightness = 0;
623         if (name) {
624                 pwm->cdev.name = name;
625                 pwm->cdev.brightness_set = lm8323_pwm_set_brightness;
626                 if (led_classdev_register(dev, &pwm->cdev) < 0) {
627                         dev_err(dev, "couldn't register PWM %d\n", id);
628                         return -1;
629                 }
630                 if (device_create_file(pwm->cdev.dev,
631                                              &dev_attr_time) < 0) {
632                         dev_err(dev, "couldn't register time attribute\n");
633                         led_classdev_unregister(&pwm->cdev);
634                         return -1;
635                 }
636                 INIT_WORK(&pwm->work, lm8323_pwm_work);
637                 pwm->enabled = 1;
638         } else {
639                 pwm->enabled = 0;
640         }
641
642         return 0;
643 }
644
645 static struct i2c_driver lm8323_i2c_driver;
646
647 static ssize_t lm8323_show_disable(struct device *dev,
648                                    struct device_attribute *attr, char *buf)
649 {
650         struct lm8323_chip *lm = dev_get_drvdata(dev);
651
652         return sprintf(buf, "%u\n", !lm->kp_enabled);
653 }
654
655 static ssize_t lm8323_set_disable(struct device *dev,
656                                   struct device_attribute *attr,
657                                   const char *buf, size_t count)
658 {
659         struct lm8323_chip *lm = dev_get_drvdata(dev);
660         int ret;
661         int i;
662
663         i = sscanf(buf, "%d", &ret);
664
665         mutex_lock(&lm->lock);
666         lm->kp_enabled = !i;
667         mutex_unlock(&lm->lock);
668
669         return count;
670 }
671 static DEVICE_ATTR(disable_kp, 0644, lm8323_show_disable, lm8323_set_disable);
672
673 static int lm8323_probe(struct i2c_client *client,
674                                         const struct i2c_device_id *id)
675 {
676         struct input_dev *idev;
677         struct lm8323_chip *lm;
678         int i, err = 0;
679         unsigned long tmo;
680         u8 data[2];
681
682         lm = kzalloc(sizeof *lm, GFP_KERNEL);
683         if (!lm)
684                 return -ENOMEM;
685
686         i2c_set_clientdata(client, lm);
687         lm->client = client;
688         lm8323_pdata = client->dev.platform_data;
689         if (!lm8323_pdata)
690                 return -EINVAL; /* ? */
691
692         lm->size_x = lm8323_pdata->size_x;
693         if (lm->size_x == 0) {
694                 lm->size_x = 8;
695         } else if (lm->size_x > 8) {
696                 dev_err(&client->dev, "invalid x size %d specified\n",
697                                 lm->size_x);
698                 lm->size_x = 8;
699         }
700
701         lm->size_y = lm8323_pdata->size_y;
702         if (lm->size_y == 0) {
703                 lm->size_y = 12;
704         } else if (lm->size_y > 12) {
705                 dev_err(&client->dev, "invalid y size %d specified\n",
706                                 lm->size_y);
707                 lm->size_x = 12;
708         }
709
710         debug(&c->dev, "Keypad size: %d x %d\n", lm->size_x, lm->size_y);
711
712         lm->debounce_time = lm8323_pdata->debounce_time;
713         if (lm->debounce_time == 0) /* Default. */
714                 lm->debounce_time = 12;
715         else if (lm->debounce_time == -1) /* Disable debounce. */
716                 lm->debounce_time = 0;
717
718         lm->active_time = lm8323_pdata->active_time;
719         if (lm->active_time == 0) /* Default. */
720                 lm->active_time = 500;
721         else if (lm->active_time == -1) /* Disable sleep. */
722                 lm->active_time = 0;
723
724         lm8323_reset(lm);
725
726         /* Nothing's set up to service the IRQ yet, so just spin for max.
727          * 100ms until we can configure. */
728         tmo = jiffies + msecs_to_jiffies(100);
729         while (lm8323_read(lm, LM8323_CMD_READ_INT, data, 1) == 1) {
730                 if (data[0] & INT_NOINIT)
731                         break;
732
733                 if (time_after(jiffies, tmo)) {
734                         dev_err(&client->dev,
735                                         "timeout waiting for initialisation\n");
736                         break;
737                 }
738
739                 msleep(1);
740         }
741         lm8323_configure(lm);
742
743         /* If a true probe check the device */
744         if (lm8323_read_id(lm, data) != 0) {
745                 dev_err(&client->dev, "device not found\n");
746                 err = -ENODEV;
747                 goto fail2;
748         }
749
750         if (init_pwm(lm, 1, &client->dev, lm8323_pdata->pwm1_name) < 0)
751                 goto fail3;
752         if (init_pwm(lm, 2, &client->dev, lm8323_pdata->pwm2_name) < 0)
753                 goto fail4;
754         if (init_pwm(lm, 3, &client->dev, lm8323_pdata->pwm3_name) < 0)
755                 goto fail5;
756
757         mutex_init(&lm->lock);
758         INIT_WORK(&lm->work, lm8323_work);
759
760         err = request_irq(client->irq, lm8323_irq,
761                           IRQF_TRIGGER_FALLING | IRQF_DISABLED |
762                           IRQF_SAMPLE_RANDOM, DRIVER_NAME, lm);
763         if (err) {
764                 dev_err(&client->dev, "could not get IRQ %d\n", client->irq);
765                 goto fail6;
766         }
767
768         set_irq_wake(client->irq, 1);
769
770         lm->kp_enabled = 1;
771         err = device_create_file(&client->dev, &dev_attr_disable_kp);
772         if (err < 0)
773                 goto fail7;
774
775         idev = input_allocate_device();
776         if (idev == NULL) {
777                 err = -ENOMEM;
778                 goto fail8;
779         }
780
781         if (lm8323_pdata->name)
782                 idev->name = lm8323_pdata->name;
783         else
784                 idev->name = "LM8323 keypad";
785         snprintf(lm->phys, sizeof(lm->phys), "%s/input-kp", client->dev.bus_id);
786         idev->phys = lm->phys;
787
788         lm->keys_down = 0;
789         idev->evbit[0] = BIT(EV_KEY);
790         for (i = 0; i < LM8323_KEYMAP_SIZE; i++) {
791                 if (lm8323_pdata->keymap[i] > 0)
792                         set_bit(lm8323_pdata->keymap[i], idev->keybit);
793
794                 lm->keymap[i] = lm8323_pdata->keymap[i];
795         }
796
797         if (lm8323_pdata->repeat)
798                 set_bit(EV_REP, idev->evbit);
799
800         lm->idev = idev;
801         err = input_register_device(idev);
802         if (err) {
803                 dev_dbg(&client->dev, "error registering input device\n");
804                 goto fail8;
805         }
806
807         return 0;
808
809 fail8:
810         device_remove_file(&client->dev, &dev_attr_disable_kp);
811 fail7:
812         free_irq(client->irq, lm);
813 fail6:
814         if (lm->pwm3.enabled)
815                 led_classdev_unregister(&lm->pwm3.cdev);
816 fail5:
817         if (lm->pwm2.enabled)
818                 led_classdev_unregister(&lm->pwm2.cdev);
819 fail4:
820         if (lm->pwm1.enabled)
821                 led_classdev_unregister(&lm->pwm1.cdev);
822 fail3:
823 fail2:
824         kfree(lm);
825         return err;
826 }
827
828 static int lm8323_remove(struct i2c_client *client)
829 {
830         struct lm8323_chip *lm = i2c_get_clientdata(client);
831
832         free_irq(client->irq, lm);
833         cancel_work_sync(&lm->work);
834         input_unregister_device(lm->idev);
835         device_remove_file(&lm->client->dev, &dev_attr_disable_kp);
836         if (lm->pwm3.enabled)
837                 led_classdev_unregister(&lm->pwm3.cdev);
838         if (lm->pwm2.enabled)
839                 led_classdev_unregister(&lm->pwm2.cdev);
840         if (lm->pwm1.enabled)
841                 led_classdev_unregister(&lm->pwm1.cdev);
842         kfree(lm);
843
844         return 0;
845 }
846
847 /*
848  * We don't need to explicitly suspend the chip, as it already switches off
849  * when there's no activity.
850  */
851 static int lm8323_suspend(struct i2c_client *client, pm_message_t mesg)
852 {
853         struct lm8323_chip *lm = i2c_get_clientdata(client);
854
855         set_irq_wake(client->irq, 0);
856         disable_irq(client->irq);
857
858         mutex_lock(&lm->lock);
859         lm->pm_suspend = 1;
860         mutex_unlock(&lm->lock);
861
862         if (lm->pwm1.enabled)
863                 led_classdev_suspend(&lm->pwm1.cdev);
864         if (lm->pwm2.enabled)
865                 led_classdev_suspend(&lm->pwm2.cdev);
866         if (lm->pwm3.enabled)
867                 led_classdev_suspend(&lm->pwm3.cdev);
868
869         return 0;
870 }
871
872 static int lm8323_resume(struct i2c_client *client)
873 {
874         struct lm8323_chip *lm = i2c_get_clientdata(client);
875
876         mutex_lock(&lm->lock);
877         lm->pm_suspend = 0;
878         mutex_unlock(&lm->lock);
879
880         if (lm->pwm1.enabled)
881                 led_classdev_resume(&lm->pwm1.cdev);
882         if (lm->pwm2.enabled)
883                 led_classdev_resume(&lm->pwm2.cdev);
884         if (lm->pwm3.enabled)
885                 led_classdev_resume(&lm->pwm3.cdev);
886
887         enable_irq(client->irq);
888         set_irq_wake(client->irq, 1);
889
890         return 0;
891 }
892
893 static const struct i2c_device_id lm8323_id[] = {
894         { DRIVER_NAME, 0 },
895         { }
896 };
897
898 static struct i2c_driver lm8323_i2c_driver = {
899         .driver = {
900                 .name    = DRIVER_NAME,
901         },
902         .probe          = lm8323_probe,
903         .remove         = __devexit_p(lm8323_remove),
904         .suspend        = lm8323_suspend,
905         .resume         = lm8323_resume,
906         .id_table       = lm8323_id,
907 };
908 MODULE_DEVICE_TABLE(i2c, lm8323_id);
909
910 static int __init lm8323_init(void)
911 {
912         return i2c_add_driver(&lm8323_i2c_driver);
913 }
914
915 static void __exit lm8323_exit(void)
916 {
917         i2c_del_driver(&lm8323_i2c_driver);
918 }
919
920 MODULE_AUTHOR("Daniel Stone");
921 MODULE_DESCRIPTION("LM8323 keypad driver");
922 MODULE_LICENSE("GPL");
923
924 module_init(lm8323_init);
925 module_exit(lm8323_exit);