1 // SPDX-License-Identifier: GPL-2.0 1 // SPDX-License-Identifier: GPL-2.0
2 /* 2 /*
3 * Filename: cfag12864b-example.c 3 * Filename: cfag12864b-example.c
4 * Version: 0.1.0 4 * Version: 0.1.0
5 * Description: cfag12864b LCD userspace examp 5 * Description: cfag12864b LCD userspace example program
6 * 6 *
7 * Author: Copyright (C) Miguel Ojeda <oj 7 * Author: Copyright (C) Miguel Ojeda <ojeda@kernel.org>
8 * Date: 2006-10-31 8 * Date: 2006-10-31
9 */ 9 */
10 10
11 /* 11 /*
12 * ------------------------ 12 * ------------------------
13 * start of cfag12864b code 13 * start of cfag12864b code
14 * ------------------------ 14 * ------------------------
15 */ 15 */
16 16
17 #include <string.h> 17 #include <string.h>
18 #include <fcntl.h> 18 #include <fcntl.h>
19 #include <unistd.h> 19 #include <unistd.h>
20 #include <sys/types.h> 20 #include <sys/types.h>
21 #include <sys/stat.h> 21 #include <sys/stat.h>
22 #include <sys/mman.h> 22 #include <sys/mman.h>
23 23
24 #define CFAG12864B_WIDTH (128) 24 #define CFAG12864B_WIDTH (128)
25 #define CFAG12864B_HEIGHT (64) 25 #define CFAG12864B_HEIGHT (64)
26 #define CFAG12864B_SIZE (128 * 26 #define CFAG12864B_SIZE (128 * 64 / 8)
27 #define CFAG12864B_BPB (8) 27 #define CFAG12864B_BPB (8)
28 #define CFAG12864B_ADDRESS(x, y) ((y) * 28 #define CFAG12864B_ADDRESS(x, y) ((y) * CFAG12864B_WIDTH / \
29 CFAG12 29 CFAG12864B_BPB + (x) / CFAG12864B_BPB)
30 #define CFAG12864B_BIT(n) (((uns 30 #define CFAG12864B_BIT(n) (((unsigned char) 1) << (n))
31 31
32 #undef CFAG12864B_DOCHECK 32 #undef CFAG12864B_DOCHECK
33 #ifdef CFAG12864B_DOCHECK 33 #ifdef CFAG12864B_DOCHECK
34 #define CFAG12864B_CHECK(x, y) 34 #define CFAG12864B_CHECK(x, y) ((x) < CFAG12864B_WIDTH && \
35 35 (y) < CFAG12864B_HEIGHT)
36 #else 36 #else
37 #define CFAG12864B_CHECK(x, y) 37 #define CFAG12864B_CHECK(x, y) (1)
38 #endif 38 #endif
39 39
40 int cfag12864b_fd; 40 int cfag12864b_fd;
41 unsigned char * cfag12864b_mem; 41 unsigned char * cfag12864b_mem;
42 unsigned char cfag12864b_buffer[CFAG12864B_SIZ 42 unsigned char cfag12864b_buffer[CFAG12864B_SIZE];
43 43
44 /* 44 /*
45 * init a cfag12864b framebuffer device 45 * init a cfag12864b framebuffer device
46 * 46 *
47 * No error: return = 0 47 * No error: return = 0
48 * Unable to open: return = -1 48 * Unable to open: return = -1
49 * Unable to mmap: return = -2 49 * Unable to mmap: return = -2
50 */ 50 */
51 static int cfag12864b_init(char *path) 51 static int cfag12864b_init(char *path)
52 { 52 {
53 cfag12864b_fd = open(path, O_RDWR); 53 cfag12864b_fd = open(path, O_RDWR);
54 if (cfag12864b_fd == -1) 54 if (cfag12864b_fd == -1)
55 return -1; 55 return -1;
56 56
57 cfag12864b_mem = mmap(0, CFAG12864B_SI 57 cfag12864b_mem = mmap(0, CFAG12864B_SIZE, PROT_READ | PROT_WRITE,
58 MAP_SHARED, cfag12864b_fd, 0); 58 MAP_SHARED, cfag12864b_fd, 0);
59 if (cfag12864b_mem == MAP_FAILED) { 59 if (cfag12864b_mem == MAP_FAILED) {
60 close(cfag12864b_fd); 60 close(cfag12864b_fd);
61 return -2; 61 return -2;
62 } 62 }
63 63
64 return 0; 64 return 0;
65 } 65 }
66 66
67 /* 67 /*
68 * exit a cfag12864b framebuffer device 68 * exit a cfag12864b framebuffer device
69 */ 69 */
70 static void cfag12864b_exit(void) 70 static void cfag12864b_exit(void)
71 { 71 {
72 munmap(cfag12864b_mem, CFAG12864B_SIZE 72 munmap(cfag12864b_mem, CFAG12864B_SIZE);
73 close(cfag12864b_fd); 73 close(cfag12864b_fd);
74 } 74 }
75 75
76 /* 76 /*
77 * set (x, y) pixel 77 * set (x, y) pixel
78 */ 78 */
79 static void cfag12864b_set(unsigned char x, un 79 static void cfag12864b_set(unsigned char x, unsigned char y)
80 { 80 {
81 if (CFAG12864B_CHECK(x, y)) 81 if (CFAG12864B_CHECK(x, y))
82 cfag12864b_buffer[CFAG12864B_A 82 cfag12864b_buffer[CFAG12864B_ADDRESS(x, y)] |=
83 CFAG12864B_BIT(x % CFA 83 CFAG12864B_BIT(x % CFAG12864B_BPB);
84 } 84 }
85 85
86 /* 86 /*
87 * unset (x, y) pixel 87 * unset (x, y) pixel
88 */ 88 */
89 static void cfag12864b_unset(unsigned char x, 89 static void cfag12864b_unset(unsigned char x, unsigned char y)
90 { 90 {
91 if (CFAG12864B_CHECK(x, y)) 91 if (CFAG12864B_CHECK(x, y))
92 cfag12864b_buffer[CFAG12864B_A 92 cfag12864b_buffer[CFAG12864B_ADDRESS(x, y)] &=
93 ~CFAG12864B_BIT(x % CF 93 ~CFAG12864B_BIT(x % CFAG12864B_BPB);
94 } 94 }
95 95
96 /* 96 /*
97 * is set (x, y) pixel? 97 * is set (x, y) pixel?
98 * 98 *
99 * Pixel off: return = 0 99 * Pixel off: return = 0
100 * Pixel on: return = 1 100 * Pixel on: return = 1
101 */ 101 */
102 static unsigned char cfag12864b_isset(unsigned 102 static unsigned char cfag12864b_isset(unsigned char x, unsigned char y)
103 { 103 {
104 if (CFAG12864B_CHECK(x, y)) 104 if (CFAG12864B_CHECK(x, y))
105 if (cfag12864b_buffer[CFAG1286 105 if (cfag12864b_buffer[CFAG12864B_ADDRESS(x, y)] &
106 CFAG12864B_BIT(x % CFA 106 CFAG12864B_BIT(x % CFAG12864B_BPB))
107 return 1; 107 return 1;
108 108
109 return 0; 109 return 0;
110 } 110 }
111 111
112 /* 112 /*
113 * not (x, y) pixel 113 * not (x, y) pixel
114 */ 114 */
115 static void cfag12864b_not(unsigned char x, un 115 static void cfag12864b_not(unsigned char x, unsigned char y)
116 { 116 {
117 if (cfag12864b_isset(x, y)) 117 if (cfag12864b_isset(x, y))
118 cfag12864b_unset(x, y); 118 cfag12864b_unset(x, y);
119 else 119 else
120 cfag12864b_set(x, y); 120 cfag12864b_set(x, y);
121 } 121 }
122 122
123 /* 123 /*
124 * fill (set all pixels) 124 * fill (set all pixels)
125 */ 125 */
126 static void cfag12864b_fill(void) 126 static void cfag12864b_fill(void)
127 { 127 {
128 unsigned short i; 128 unsigned short i;
129 129
130 for (i = 0; i < CFAG12864B_SIZE; i++) 130 for (i = 0; i < CFAG12864B_SIZE; i++)
131 cfag12864b_buffer[i] = 0xFF; 131 cfag12864b_buffer[i] = 0xFF;
132 } 132 }
133 133
134 /* 134 /*
135 * clear (unset all pixels) 135 * clear (unset all pixels)
136 */ 136 */
137 static void cfag12864b_clear(void) 137 static void cfag12864b_clear(void)
138 { 138 {
139 unsigned short i; 139 unsigned short i;
140 140
141 for (i = 0; i < CFAG12864B_SIZE; i++) 141 for (i = 0; i < CFAG12864B_SIZE; i++)
142 cfag12864b_buffer[i] = 0; 142 cfag12864b_buffer[i] = 0;
143 } 143 }
144 144
145 /* 145 /*
146 * format a [128*64] matrix 146 * format a [128*64] matrix
147 * 147 *
148 * Pixel off: src[i] = 0 148 * Pixel off: src[i] = 0
149 * Pixel on: src[i] > 0 149 * Pixel on: src[i] > 0
150 */ 150 */
151 static void cfag12864b_format(unsigned char * 151 static void cfag12864b_format(unsigned char * matrix)
152 { 152 {
153 unsigned char i, j, n; 153 unsigned char i, j, n;
154 154
155 for (i = 0; i < CFAG12864B_HEIGHT; i++ 155 for (i = 0; i < CFAG12864B_HEIGHT; i++)
156 for (j = 0; j < CFAG12864B_WIDTH / CFA 156 for (j = 0; j < CFAG12864B_WIDTH / CFAG12864B_BPB; j++) {
157 cfag12864b_buffer[i * CFAG1286 157 cfag12864b_buffer[i * CFAG12864B_WIDTH / CFAG12864B_BPB +
158 j] = 0; 158 j] = 0;
159 for (n = 0; n < CFAG12864B_BPB 159 for (n = 0; n < CFAG12864B_BPB; n++)
160 if (matrix[i * CFAG128 160 if (matrix[i * CFAG12864B_WIDTH +
161 j * CFAG12864B 161 j * CFAG12864B_BPB + n])
162 cfag12864b_buf 162 cfag12864b_buffer[i * CFAG12864B_WIDTH /
163 CFAG12 163 CFAG12864B_BPB + j] |=
164 CFAG12 164 CFAG12864B_BIT(n);
165 } 165 }
166 } 166 }
167 167
168 /* 168 /*
169 * blit buffer to lcd 169 * blit buffer to lcd
170 */ 170 */
171 static void cfag12864b_blit(void) 171 static void cfag12864b_blit(void)
172 { 172 {
173 memcpy(cfag12864b_mem, cfag12864b_buff 173 memcpy(cfag12864b_mem, cfag12864b_buffer, CFAG12864B_SIZE);
174 } 174 }
175 175
176 /* 176 /*
177 * ---------------------- 177 * ----------------------
178 * end of cfag12864b code 178 * end of cfag12864b code
179 * ---------------------- 179 * ----------------------
180 */ 180 */
181 181
182 #include <stdio.h> 182 #include <stdio.h>
183 183
184 #define EXAMPLES 6 184 #define EXAMPLES 6
185 185
186 static void example(unsigned char n) 186 static void example(unsigned char n)
187 { 187 {
188 unsigned short i, j; 188 unsigned short i, j;
189 unsigned char matrix[CFAG12864B_WIDTH 189 unsigned char matrix[CFAG12864B_WIDTH * CFAG12864B_HEIGHT];
190 190
191 if (n > EXAMPLES) 191 if (n > EXAMPLES)
192 return; 192 return;
193 193
194 printf("Example %i/%i - ", n, EXAMPLES 194 printf("Example %i/%i - ", n, EXAMPLES);
195 195
196 switch (n) { 196 switch (n) {
197 case 1: 197 case 1:
198 printf("Draw points setting bi 198 printf("Draw points setting bits");
199 cfag12864b_clear(); 199 cfag12864b_clear();
200 for (i = 0; i < CFAG12864B_WID 200 for (i = 0; i < CFAG12864B_WIDTH; i += 2)
201 for (j = 0; j < CFAG12 201 for (j = 0; j < CFAG12864B_HEIGHT; j += 2)
202 cfag12864b_set 202 cfag12864b_set(i, j);
203 break; 203 break;
204 204
205 case 2: 205 case 2:
206 printf("Clear the LCD"); 206 printf("Clear the LCD");
207 cfag12864b_clear(); 207 cfag12864b_clear();
208 break; 208 break;
209 209
210 case 3: 210 case 3:
211 printf("Draw rows formatting a 211 printf("Draw rows formatting a [128*64] matrix");
212 memset(matrix, 0, CFAG12864B_W 212 memset(matrix, 0, CFAG12864B_WIDTH * CFAG12864B_HEIGHT);
213 for (i = 0; i < CFAG12864B_WID 213 for (i = 0; i < CFAG12864B_WIDTH; i++)
214 for (j = 0; j < CFAG12 214 for (j = 0; j < CFAG12864B_HEIGHT; j += 2)
215 matrix[j * CFA 215 matrix[j * CFAG12864B_WIDTH + i] = 1;
216 cfag12864b_format(matrix); 216 cfag12864b_format(matrix);
217 break; 217 break;
218 218
219 case 4: 219 case 4:
220 printf("Fill the lcd"); 220 printf("Fill the lcd");
221 cfag12864b_fill(); 221 cfag12864b_fill();
222 break; 222 break;
223 223
224 case 5: 224 case 5:
225 printf("Draw columns unsetting 225 printf("Draw columns unsetting bits");
226 for (i = 0; i < CFAG12864B_WID 226 for (i = 0; i < CFAG12864B_WIDTH; i += 2)
227 for (j = 0; j < CFAG12 227 for (j = 0; j < CFAG12864B_HEIGHT; j++)
228 cfag12864b_uns 228 cfag12864b_unset(i, j);
229 break; 229 break;
230 230
231 case 6: 231 case 6:
232 printf("Do negative not-ing al 232 printf("Do negative not-ing all bits");
233 for (i = 0; i < CFAG12864B_WID 233 for (i = 0; i < CFAG12864B_WIDTH; i++)
234 for (j = 0; j < CFAG12 234 for (j = 0; j < CFAG12864B_HEIGHT; j ++)
235 cfag12864b_not 235 cfag12864b_not(i, j);
236 break; 236 break;
237 } 237 }
238 238
239 puts(" - [Press Enter]"); 239 puts(" - [Press Enter]");
240 } 240 }
241 241
242 int main(int argc, char *argv[]) 242 int main(int argc, char *argv[])
243 { 243 {
244 unsigned char n; 244 unsigned char n;
245 245
246 if (argc != 2) { 246 if (argc != 2) {
247 printf( 247 printf(
248 "Syntax: %s fbdev\n" 248 "Syntax: %s fbdev\n"
249 "Usually: /dev/fb0, /d 249 "Usually: /dev/fb0, /dev/fb1...\n", argv[0]);
250 return -1; 250 return -1;
251 } 251 }
252 252
253 if (cfag12864b_init(argv[1])) { 253 if (cfag12864b_init(argv[1])) {
254 printf("Can't init %s fbdev\n" 254 printf("Can't init %s fbdev\n", argv[1]);
255 return -2; 255 return -2;
256 } 256 }
257 257
258 for (n = 1; n <= EXAMPLES; n++) { 258 for (n = 1; n <= EXAMPLES; n++) {
259 example(n); 259 example(n);
260 cfag12864b_blit(); 260 cfag12864b_blit();
261 while (getchar() != '\n'); 261 while (getchar() != '\n');
262 } 262 }
263 263
264 cfag12864b_exit(); 264 cfag12864b_exit();
265 265
266 return 0; 266 return 0;
267 } 267 }
268 268
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.