Grove-LCD-RGB-Backlight-Pico-Drivers/backlight.c at master · Naquino14/Grove-LCD-RGB-Backlight-Pico-Drivers · GitHub

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
#include "backlight.h"

static byte _backlight_addr = 0x0;

static void checkaddr() {
    const byte cmd = 0x00;
    i2c_write_blocking(i2c0, backlight_addr, &cmd, 0, true);

    byte out;
    int status = i2c_read_blocking(i2c0, backlight_addr, &out, 1, false);
    if ((status != PICO_ERROR_GENERIC && status > 0) && out == MODE1_DEFAULT) {
        _backlight_addr = backlight_addr;
        return;
    }
    sleep_us(200);
}

void backlight_init(i2c_inst_t* i2cport, uint sdaport, uint sclport) {
    checkaddr();

    if (_backlight_addr == 0x0) {
        printf("Backlight not found\n");
        return;
    }
    byte cmd[2];
    // init backlight

    // set MODE1 register to 0x0 to initialize the backlight
    cmd[0] = MODE1;
    cmd[1] = 0x0;
    i2c_write_blocking(i2cport, _backlight_addr, cmd, 2, false);
    sleep_us(200);

    // set OUTPUT register to work with PWM and GRPPWM
    cmd[0] = LEDOUT;
    cmd[1] = 0xFF;
    i2c_write_blocking(i2cport, _backlight_addr, cmd, 2, false);
    sleep_us(200);

    // set MODE2 register to enable DMBLNK
    cmd[0] = MODE2;
    cmd[1] = 0x20;
    i2c_write_blocking(i2cport, _backlight_addr, cmd, 2, false);
    sleep_us(200);

    // set backlight color to white
    backlight_set_color(0xFF, 0xFF, 0xFF);
}

void backlight_set_color(byte red, byte green, byte blue) {
    byte cmd[2];
    if (_backlight_addr == backlight_addr_v5) {
        cmd[0] = REG_RED_V5;
        cmd[1] = red;
        i2c_write_blocking(i2c0, _backlight_addr, cmd, 2, false);
        cmd[0] = REG_GREEN_V5;
        cmd[1] = green;
        i2c_write_blocking(i2c0, _backlight_addr, cmd, 2, false);
        cmd[0] = REG_BLUE_V5;
        cmd[1] = blue;
        i2c_write_blocking(i2c0, _backlight_addr, cmd, 2, false);
    } else {
        cmd[0] = REG_RED;
        cmd[1] = red;
        i2c_write_blocking(i2c0, _backlight_addr, cmd, 2, false);
        cmd[0] = REG_GREEN;
        cmd[1] = green;
        i2c_write_blocking(i2c0, _backlight_addr, cmd, 2, false);
        cmd[0] = REG_BLUE;
        cmd[1] = blue;
        i2c_write_blocking(i2c0, _backlight_addr, cmd, 2, false);
    }
    sleep_us(200);
}