6893ccd41e4741c506eee35b7bd57c4225200c71
[fw/altos] / src / drivers / ao_st7565.c
1 /*
2  * Copyright © 2023 Keith Packard <keithp@keithp.com>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation, either version 2 of the License, or
7  * (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but
10  * WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License along
15  * with this program; if not, write to the Free Software Foundation, Inc.,
16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
17  */
18
19 #include <ao.h>
20 #include <ao_st7565.h>
21
22 static void
23 ao_st7565_reset(void)
24 {
25         ao_gpio_set(AO_ST7565_RESET_PORT, AO_ST7565_RESET_PIN, 0);
26         ao_delay(AO_MS_TO_TICKS(100));
27         ao_gpio_set(AO_ST7565_RESET_PORT, AO_ST7565_RESET_PIN, 1);
28         ao_delay(AO_MS_TO_TICKS(100));
29 }
30
31
32 static void
33 ao_st7565_start(uint8_t a0)
34 {
35         ao_gpio_set(AO_ST7565_A0_PORT, AO_ST7565_A0_PIN, a0);
36         ao_spi_get_bit(AO_ST7565_CS_PORT,
37                        AO_ST7565_CS_PIN,
38                        AO_ST7565_SPI_BUS,
39                        AO_ST7565_SPI_SPEED);
40 }
41
42 static void
43 ao_st7565_stop(void)
44 {
45         ao_spi_put_bit(AO_ST7565_CS_PORT,
46                        AO_ST7565_CS_PIN,
47                        AO_ST7565_SPI_BUS);
48         ao_gpio_set(AO_ST7565_A0_PORT, AO_ST7565_A0_PIN, 1);
49 }
50
51
52 static void
53 ao_st7565_instruction(uint8_t cmd)
54 {
55         ao_st7565_start(0);
56         ao_spi_send(&cmd, 1, AO_ST7565_SPI_BUS);
57         ao_st7565_stop();
58 }
59
60 static void
61 ao_st7565_instruction_param(uint8_t cmd, uint8_t param)
62 {
63         uint8_t b[2] = { cmd, param };
64         ao_st7565_start(0);
65         ao_spi_send(b, 2, AO_ST7565_SPI_BUS);
66         ao_st7565_stop();
67 }
68
69 static void
70 ao_st7565_instructions(const uint8_t *cmd, uint16_t len)
71 {
72         ao_st7565_start(0);
73         ao_spi_send(cmd, len, AO_ST7565_SPI_BUS);
74         ao_st7565_stop();
75 }
76
77 static void
78 ao_st7565_data(const void *base, uint16_t len)
79 {
80         ao_st7565_start(1);
81         ao_spi_send(base, len, AO_ST7565_SPI_BUS);
82         ao_st7565_stop();
83 }
84
85 static void
86 ao_st7565_set_brightness(uint8_t val)
87 {
88         ao_st7565_instruction_param(ST7565_ELECTRONIC_VOLUME_SET, val);
89 }
90
91 static bool setup_done;
92
93 static void
94 ao_st7565_setup(void)
95 {
96         static const uint8_t init[] = {
97                 /*
98                  * Should be set to one of ST7565_LCD_BIAS_1_9 or
99                  * ST7565_LCD_BIAS_1_7
100                  */
101                 AO_ST7565_BIAS,
102                 ST7565_ADC_SELECT_NORMAL,
103                 ST7565_COMMON_MODE_NORMAL,
104                 ST7565_DISPLAY_START_LINE_SET(0),
105                 ST7565_POWER_CONTROL_SET(0x4),
106         };
107
108         if (setup_done)
109                 return;
110         setup_done = true;
111         ao_st7565_reset();
112         ao_st7565_instructions(init, sizeof(init));
113         ao_delay(AO_MS_TO_TICKS(50));
114         ao_st7565_instruction(ST7565_POWER_CONTROL_SET(0x6));
115         ao_delay(AO_MS_TO_TICKS(50));
116         ao_st7565_instruction(ST7565_POWER_CONTROL_SET(0x7));
117         ao_delay(AO_MS_TO_TICKS(10));
118         ao_st7565_instruction(ST7565_RESISTOR_RATIO_SET(5));
119         ao_st7565_instruction(ST7565_DISPLAY_ON);
120         ao_st7565_set_brightness(0x10);
121 }
122
123 static uint8_t  rotbuf[AO_ST7565_WIDTH];
124
125 void
126 ao_st7565_update(struct ao_bitmap *bitmap)
127 {
128         uint8_t         col, c, page;
129         int             row;
130         uint32_t        *line;
131         uint8_t         *r;
132
133         ao_st7565_setup();
134
135         line = bitmap->base;
136         for (page = 0; page < 8; page++) {
137                 uint8_t         i[4] = {
138                         ST7565_PAGE_ADDRESS_SET(7-page),
139                         ST7565_COLUMN_ADDRESS_SET_MSN(0 >> 4),
140                         ST7565_COLUMN_ADDRESS_SET_MSN(0 & 0xf),
141                         ST7565_RMW
142                 };
143                 memset(rotbuf, 0, sizeof(rotbuf));
144                 for (row = 7; row >= 0; row--) {
145                         r = rotbuf;
146                         for (col = 0; col < AO_BITMAP_STRIDE(AO_ST7565_WIDTH); col++) {
147                                 uint32_t        bits = ~*line++;
148                                 for (c = 0; c < 32; c++) {
149                                         *r++ |= ((bits >> c) & 1) << row;
150                                 }
151                         }
152                 }
153                 ao_st7565_instructions(i, 4);
154                 ao_st7565_data(rotbuf, AO_ST7565_WIDTH);
155         }
156 }
157
158 void
159 ao_st7565_init(void)
160 {
161         ao_enable_output(AO_ST7565_RESET_PORT, AO_ST7565_RESET_PIN, 1);
162         ao_enable_output(AO_ST7565_A0_PORT, AO_ST7565_A0_PIN, 1);
163
164         ao_enable_cs(AO_ST7565_CS_PORT, AO_ST7565_CS_PIN);
165 }