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