forked from zephyrproject-rtos/zephyr
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathlcd_rgb.c
349 lines (264 loc) · 8.04 KB
/
lcd_rgb.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
/*
* Copyright (c) 2015 Intel Corporation
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <errno.h>
#include <kernel.h>
#include <init.h>
#include <stdbool.h>
#include <i2c.h>
#include <display/grove_lcd.h>
#include <misc/util.h>
#define SYS_LOG_DOMAIN "Grove LCD"
#define SYS_LOG_LEVEL CONFIG_SYS_LOG_GROVE_LEVEL
#include <logging/sys_log.h>
#define SLEEP_IN_US(_x_) ((_x_) * 1000)
#define GROVE_LCD_DISPLAY_ADDR (0x3E)
#define GROVE_RGB_BACKLIGHT_ADDR (0x62)
struct command {
u8_t control;
u8_t data;
};
struct glcd_data {
struct device *i2c;
u8_t input_set;
u8_t display_switch;
u8_t function;
};
struct glcd_driver {
u16_t lcd_addr;
u16_t rgb_addr;
};
#define ON 0x1
#define OFF 0x0
/********************************************
* LCD FUNCTIONS
*******************************************/
/* GLCD_CMD_SCREEN_CLEAR has no options */
/* GLCD_CMD_CURSOR_RETURN has no options */
/* Defines for the GLCD_CMD_CURSOR_SHIFT */
#define GLCD_CS_DISPLAY_SHIFT (1 << 3)
#define GLCD_CS_RIGHT_SHIFT (1 << 2)
/* LCD Display Commands */
#define GLCD_CMD_SCREEN_CLEAR (1 << 0)
#define GLCD_CMD_CURSOR_RETURN (1 << 1)
#define GLCD_CMD_INPUT_SET (1 << 2)
#define GLCD_CMD_DISPLAY_SWITCH (1 << 3)
#define GLCD_CMD_CURSOR_SHIFT (1 << 4)
#define GLCD_CMD_FUNCTION_SET (1 << 5)
#define GLCD_CMD_SET_CGRAM_ADDR (1 << 6)
#define GLCD_CMD_SET_DDRAM_ADDR (1 << 7)
/********************************************
* RGB FUNCTIONS
*******************************************/
#define REGISTER_POWER 0x08
#define REGISTER_R 0x04
#define REGISTER_G 0x03
#define REGISTER_B 0x02
static u8_t color_define[][3] = {
{ 255, 255, 255 }, /* white */
{ 255, 0, 0 }, /* red */
{ 0, 255, 0 }, /* green */
{ 0, 0, 255 }, /* blue */
};
/********************************************
* PRIVATE FUNCTIONS
*******************************************/
static void _rgb_reg_set(struct device * const i2c, u8_t addr, u8_t dta)
{
u8_t data[2] = { addr, dta };
i2c_write(i2c, data, sizeof(data), GROVE_RGB_BACKLIGHT_ADDR);
}
static inline void _sleep(u32_t sleep_in_ms)
{
k_busy_wait(SLEEP_IN_US(sleep_in_ms));
}
/********************************************
* PUBLIC FUNCTIONS
*******************************************/
void glcd_print(struct device *port, char *data, u32_t size)
{
const struct glcd_driver * const rom = (struct glcd_driver *)
port->config->config_info;
struct glcd_data *dev = port->driver_data;
u8_t buf[] = { GLCD_CMD_SET_CGRAM_ADDR, 0 };
int i;
for (i = 0; i < size; i++) {
buf[1] = data[i];
i2c_write(dev->i2c, buf, sizeof(buf), rom->lcd_addr);
}
}
void glcd_cursor_pos_set(struct device *port, u8_t col, u8_t row)
{
const struct glcd_driver * const rom = (struct glcd_driver *)
port->config->config_info;
struct glcd_data *dev = port->driver_data;
unsigned char data[2];
if (row == 0) {
col |= 0x80;
} else {
col |= 0xC0;
}
data[0] = GLCD_CMD_SET_DDRAM_ADDR;
data[1] = col;
i2c_write(dev->i2c, data, 2, rom->lcd_addr);
}
void glcd_clear(struct device *port)
{
const struct glcd_driver * const rom = (struct glcd_driver *)
port->config->config_info;
struct glcd_data *dev = port->driver_data;
u8_t clear[] = { 0, GLCD_CMD_SCREEN_CLEAR };
i2c_write(dev->i2c, clear, sizeof(clear), rom->lcd_addr);
SYS_LOG_DBG("clear, delay 20 ms");
_sleep(20);
}
void glcd_display_state_set(struct device *port, u8_t opt)
{
const struct glcd_driver * const rom = (struct glcd_driver *)
port->config->config_info;
struct glcd_data *dev = port->driver_data;
u8_t data[] = { 0, 0 };
dev->display_switch = opt;
data[1] = (opt | GLCD_CMD_DISPLAY_SWITCH);
i2c_write(dev->i2c, data, sizeof(data), rom->lcd_addr);
SYS_LOG_DBG("set display_state options, delay 5 ms");
_sleep(5);
}
u8_t glcd_display_state_get(struct device *port)
{
struct glcd_data *dev = port->driver_data;
return dev->display_switch;
}
void glcd_input_state_set(struct device *port, u8_t opt)
{
const struct glcd_driver * const rom = port->config->config_info;
struct glcd_data *dev = port->driver_data;
u8_t data[] = { 0, 0 };
dev->input_set = opt;
data[1] = (opt | GLCD_CMD_INPUT_SET);
i2c_write(dev->i2c, &dev->input_set, sizeof(dev->input_set),
rom->lcd_addr);
SYS_LOG_DBG("set the input_set, no delay");
}
u8_t glcd_input_state_get(struct device *port)
{
struct glcd_data *dev = port->driver_data;
return dev->input_set;
}
void glcd_color_select(struct device *port, u8_t color)
{
if (color > 3) {
SYS_LOG_WRN("selected color is too high a value");
return;
}
glcd_color_set(port, color_define[color][0],
color_define[color][1],
color_define[color][2]);
}
void glcd_color_set(struct device *port, u8_t r, u8_t g, u8_t b)
{
struct glcd_data * const dev = port->driver_data;
_rgb_reg_set(dev->i2c, REGISTER_R, r);
_rgb_reg_set(dev->i2c, REGISTER_G, g);
_rgb_reg_set(dev->i2c, REGISTER_B, b);
}
void glcd_function_set(struct device *port, u8_t opt)
{
const struct glcd_driver * const rom = port->config->config_info;
struct glcd_data *dev = port->driver_data;
u8_t data[] = { 0, 0 };
dev->function = opt;
data[1] = (opt | GLCD_CMD_FUNCTION_SET);
i2c_write(dev->i2c, data, sizeof(data), rom->lcd_addr);
SYS_LOG_DBG("set function options, delay 5 ms");
_sleep(5);
}
u8_t glcd_function_get(struct device *port)
{
struct glcd_data *dev = port->driver_data;
return dev->function;
}
int glcd_initialize(struct device *port)
{
struct glcd_data *dev = port->driver_data;
u8_t cmd;
SYS_LOG_DBG("initialize called");
dev->input_set = 0;
dev->display_switch = 0;
dev->function = 0;
/*
* First set up the device driver...
* we need a pointer to the I2C device we are bound to
*/
dev->i2c = device_get_binding(
CONFIG_GROVE_LCD_RGB_I2C_MASTER_DEV_NAME);
if (!dev->i2c) {
return -EPERM;
}
/* Since device_get_binding() will not return any
* reference to a driver instance if port->driver_api
* is NULL and grove_lcd does not have any API struct,
* just populate it with some magic number
* so grove_lcd can be referenced.
*
* Since dev is probably still in registers.
* use that to minimize code addition.
*/
port->driver_api = (void *)dev;
/*
* Initialization sequence from the data sheet:
* 1 - Power on
* - Wait for more than 30 ms AFTER VDD rises to 4.5v
* 2 - Send FUNCTION set
* - Wait for 39 us
* 3 - Send DISPLAY Control
* - wait for 39 us
* 4 - send DISPLAY Clear
* - wait for 1.5 ms
* 5 - send ENTRY Mode
* 6 - Initialization is done
*/
/*
* We're here! Let's just make sure we've had enough time for the
* VDD to power on, so pause a little here, 30 ms min, so we go 50
*/
SYS_LOG_DBG("delay 50 ms while the VDD powers on");
_sleep(50);
/* Configure everything for the display function first */
cmd = GLCD_CMD_FUNCTION_SET | GLCD_FS_ROWS_2;
glcd_function_set(port, cmd);
/* turn the display on - by default no cursor and no blinking */
cmd = GLCD_DS_DISPLAY_ON | GLCD_DS_CURSOR_OFF | GLCD_DS_BLINK_OFF;
glcd_display_state_set(port, cmd);
/* Clear the screen */
glcd_clear(port);
/* Initialize to the default text direction for romance languages */
cmd = GLCD_IS_ENTRY_LEFT | GLCD_IS_SHIFT_DECREMENT;
glcd_input_state_set(port, cmd);
/* Now power on the background RGB control */
SYS_LOG_INF("configuring the RGB background");
_rgb_reg_set(dev->i2c, 0x00, 0x00);
_rgb_reg_set(dev->i2c, 0x01, 0x05);
_rgb_reg_set(dev->i2c, 0x08, 0xAA);
/* Now set the background color to white */
SYS_LOG_DBG("background set to white");
_rgb_reg_set(dev->i2c, REGISTER_R, color_define[GROVE_RGB_WHITE][0]);
_rgb_reg_set(dev->i2c, REGISTER_G, color_define[GROVE_RGB_WHITE][1]);
_rgb_reg_set(dev->i2c, REGISTER_B, color_define[GROVE_RGB_WHITE][2]);
return 0;
}
static const struct glcd_driver grove_lcd_config = {
.lcd_addr = GROVE_LCD_DISPLAY_ADDR,
.rgb_addr = GROVE_RGB_BACKLIGHT_ADDR,
};
static struct glcd_data grove_lcd_driver = {
.i2c = NULL,
.input_set = 0,
.display_switch = 0,
.function = 0,
};
DEVICE_INIT(grove_lcd, GROVE_LCD_NAME, glcd_initialize,
&grove_lcd_driver, &grove_lcd_config,
POST_KERNEL, CONFIG_APPLICATION_INIT_PRIORITY);