]> git.sur5r.net Git - u-boot/blob - drivers/misc/pca9551_led.c
arm: mvebu: Disable L2 cache before enabling d-cache
[u-boot] / drivers / misc / pca9551_led.c
1 /*
2  * Copyright (C) 2015 Stefan Roese <sr@denx.de>
3  *
4  * SPDX-License-Identifier:     GPL-2.0+
5  */
6
7 #include <common.h>
8 #include <errno.h>
9 #include <i2c.h>
10
11 #ifndef CONFIG_PCA9551_I2C_ADDR
12 #error "CONFIG_PCA9551_I2C_ADDR not defined!"
13 #endif
14
15 #define PCA9551_REG_INPUT       0x00    /* Input register (read only) */
16 #define PCA9551_REG_PSC0        0x01    /* Frequency prescaler 0 */
17 #define PCA9551_REG_PWM0        0x02    /* PWM0 */
18 #define PCA9551_REG_PSC1        0x03    /* Frequency prescaler 1 */
19 #define PCA9551_REG_PWM1        0x04    /* PWM1 */
20 #define PCA9551_REG_LS0         0x05    /* LED0 to LED3 selector */
21 #define PCA9551_REG_LS1         0x06    /* LED4 to LED7 selector */
22
23 #define PCA9551_CTRL_AI         (1 << 4)        /* Auto-increment flag */
24
25 #define PCA9551_LED_STATE_ON            0x00
26 #define PCA9551_LED_STATE_OFF           0x01
27 #define PCA9551_LED_STATE_BLINK0        0x02
28 #define PCA9551_LED_STATE_BLINK1        0x03
29
30 struct pca9551_blink_rate {
31         u8 psc; /* Frequency preescaler, see PCA9551_7.pdf p. 6 */
32         u8 pwm; /* Pulse width modulation, see PCA9551_7.pdf p. 6 */
33 };
34
35 static int freq0, freq1;
36
37 static int pca9551_led_get_state(int led, int *state)
38 {
39         unsigned int reg;
40         u8 shift, buf;
41         int ret;
42
43         if (led < 0 || led > 7) {
44                 return -EINVAL;
45         } else if (led < 4) {
46                 reg = PCA9551_REG_LS0;
47                 shift = led << 1;
48         } else {
49                 reg = PCA9551_REG_LS1;
50                 shift = (led - 4) << 1;
51         }
52
53         ret = i2c_read(CONFIG_PCA9551_I2C_ADDR, reg, 1, &buf, 1);
54         if (ret)
55                 return ret;
56
57         *state = (buf >> shift) & 0x03;
58         return 0;
59 }
60
61 static int pca9551_led_set_state(int led, int state)
62 {
63         unsigned int reg;
64         u8 shift, buf, mask;
65         int ret;
66
67         if (led < 0 || led > 7) {
68                 return -EINVAL;
69         } else if (led < 4) {
70                 reg = PCA9551_REG_LS0;
71                 shift = led << 1;
72         } else {
73                 reg = PCA9551_REG_LS1;
74                 shift = (led - 4) << 1;
75         }
76         mask = 0x03 << shift;
77
78         ret = i2c_read(CONFIG_PCA9551_I2C_ADDR, reg, 1, &buf, 1);
79         if (ret)
80                 return ret;
81
82         buf = (buf & ~mask) | ((state & 0x03) << shift);
83
84         ret = i2c_write(CONFIG_PCA9551_I2C_ADDR, reg, 1, &buf, 1);
85         if (ret)
86                 return ret;
87
88         return 0;
89 }
90
91 static int pca9551_led_set_blink_rate(int idx, struct pca9551_blink_rate rate)
92 {
93         unsigned int reg;
94         int ret;
95
96         switch (idx) {
97         case 0:
98                 reg = PCA9551_REG_PSC0;
99                 break;
100         case 1:
101                 reg = PCA9551_REG_PSC1;
102                 break;
103         default:
104                 return -EINVAL;
105         }
106         reg |= PCA9551_CTRL_AI;
107
108         ret = i2c_write(CONFIG_PCA9551_I2C_ADDR, reg, 1, (u8 *)&rate, 2);
109         if (ret)
110                 return ret;
111
112         return 0;
113 }
114
115 /*
116  * Functions referenced by cmd_led.c
117  */
118 void __led_set(led_id_t mask, int state)
119 {
120         if (state == STATUS_LED_OFF)
121                 pca9551_led_set_state(mask, PCA9551_LED_STATE_OFF);
122         else
123                 pca9551_led_set_state(mask, PCA9551_LED_STATE_ON);
124 }
125
126 void __led_toggle(led_id_t mask)
127 {
128         int state = 0;
129
130         pca9551_led_get_state(mask, &state);
131         pca9551_led_set_state(mask, !state);
132 }
133
134 void __led_blink(led_id_t mask, int freq)
135 {
136         struct pca9551_blink_rate rate;
137         int mode;
138         int blink;
139
140         if ((freq0 == 0) || (freq == freq0)) {
141                 blink = 0;
142                 mode = PCA9551_LED_STATE_BLINK0;
143                 freq0 = freq;
144         } else {
145                 blink = 1;
146                 mode = PCA9551_LED_STATE_BLINK1;
147                 freq1 = freq;
148         }
149
150         rate.psc = ((freq * 38) / 1000) - 1;
151         rate.pwm = 128;         /* 50% duty cycle */
152
153         pca9551_led_set_blink_rate(blink, rate);
154         pca9551_led_set_state(mask, mode);
155 }