1 /* 2 * Display the physical keypad matrix layout for the Ben NanoNote. 3 * 4 * Copyright (C) 2018 Paul Boddie <paul@boddie.org.uk> 5 * 6 * This program is free software; you can redistribute it and/or 7 * modify it under the terms of the GNU General Public License as 8 * published by the Free Software Foundation; either version 2 of 9 * the License, or (at your option) any later version. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 * 16 * You should have received a copy of the GNU General Public License 17 * along with this program; if not, write to the Free Software 18 * Foundation, Inc., 51 Franklin Street, Fifth Floor, 19 * Boston, MA 02110-1301, USA 20 */ 21 22 #include <l4/re/c/rm.h> 23 #include <l4/re/c/util/cap_alloc.h> 24 #include <l4/re/env.h> 25 #include <l4/util/util.h> 26 #include <l4/sys/ipc.h> 27 28 #include <l4/re/c/util/video/goos_fb.h> 29 #include <l4/re/c/video/view.h> 30 31 #include <l4/util/util.h> 32 #include <stdio.h> 33 #include <unistd.h> 34 #include <stdint.h> 35 #include <stdlib.h> 36 37 enum Jz4740_keypad_gpio 38 { 39 Jz4740_keypad_gpio_inputs_count = 8, 40 Jz4740_keypad_gpio_outputs_count = 8, 41 }; 42 43 /* Video abstractions. */ 44 45 static l4re_util_video_goos_fb_t gfb; 46 static l4re_video_view_info_t fbi; 47 static void *fb; 48 49 /* Keypad status and dimensions. */ 50 51 uint32_t *keypad = 0; 52 void *keymem = 0; 53 int columns = Jz4740_keypad_gpio_outputs_count, rows = Jz4740_keypad_gpio_inputs_count; 54 55 /* Position units. */ 56 57 enum { 58 KEY = 12, DIRKEY = 8, 59 WIDTH = 120, HEIGHT = 72, ROWS = 6, 60 }; 61 62 /* 63 F1 F2 F3 F4 F5 F6 F7 F8 64 Q W E R T Y U I O P 65 A S D F G H J K L Bsp 66 Esc Z X C V B N M = Enter 67 Tab Cap \ ' , . / Up V-Up 68 LSh LAl Fn Sym Spc Qi Ctr Lt Dn Rt V-Dn 69 */ 70 71 enum { 72 SIZE_KEY_F1 = KEY, SIZE_KEY_F2 = KEY, SIZE_KEY_F3 = KEY, SIZE_KEY_F4 = KEY, 73 SIZE_KEY_F5 = KEY, SIZE_KEY_F6 = KEY, SIZE_KEY_F7 = KEY, SIZE_KEY_F8 = KEY, 74 75 SIZE_KEY_Q = KEY, SIZE_KEY_W = KEY, SIZE_KEY_E = KEY, SIZE_KEY_R = KEY, 76 SIZE_KEY_T = KEY, SIZE_KEY_Y = KEY, SIZE_KEY_U = KEY, SIZE_KEY_I = KEY, 77 SIZE_KEY_O = KEY, SIZE_KEY_P = KEY, 78 79 SIZE_KEY_A = KEY, SIZE_KEY_S = KEY, SIZE_KEY_D = KEY, SIZE_KEY_F = KEY, 80 SIZE_KEY_G = KEY, SIZE_KEY_H = KEY, SIZE_KEY_J = KEY, SIZE_KEY_K = KEY, 81 SIZE_KEY_L = KEY, SIZE_KEY_BACKSPACE = KEY, 82 83 SIZE_KEY_ESCAPE = KEY, SIZE_KEY_Z = KEY, SIZE_KEY_X = KEY, SIZE_KEY_C = KEY, 84 SIZE_KEY_V = KEY, SIZE_KEY_B = KEY, SIZE_KEY_N = KEY, SIZE_KEY_M = KEY, 85 SIZE_KEY_EQUAL = KEY, SIZE_KEY_ENTER = KEY, 86 87 SIZE_KEY_TAB = KEY, SIZE_KEY_DOWNSHIFT = KEY, SIZE_KEY_BACKSLASH = KEY, SIZE_KEY_APOSTROPHE = KEY, 88 SIZE_KEY_COMMA = KEY, SIZE_KEY_DOT = KEY, SIZE_KEY_SLASH = KEY, 89 SIZE_KEY_UP = DIRKEY, SIZE_KEY_VOLUMEUP = KEY, 90 91 SIZE_KEY_LEFTSHIFT = KEY, SIZE_KEY_LEFTALT = KEY, SIZE_KEY_FN = KEY, SIZE_KEY_SYM = KEY, 92 SIZE_KEY_SPACE = KEY, SIZE_KEY_QI = KEY, SIZE_KEY_RIGHTCTRL = KEY, SIZE_KEY_LEFT = DIRKEY, 93 SIZE_KEY_DOWN = DIRKEY, SIZE_KEY_RIGHT = DIRKEY, SIZE_KEY_VOLUMEDOWN = KEY, 94 }; 95 96 enum { 97 XPOS_KEY_F1 = 2*KEY, XPOS_KEY_F2 = 3*KEY, XPOS_KEY_F3 = 4*KEY, XPOS_KEY_F4 = 5*KEY, 98 XPOS_KEY_F5 = 6*KEY, XPOS_KEY_F6 = 7*KEY, XPOS_KEY_F7 = 8*KEY, XPOS_KEY_F8 = 9*KEY, 99 100 XPOS_KEY_Q = 0, XPOS_KEY_W = KEY, XPOS_KEY_E = 2*KEY, XPOS_KEY_R = 3*KEY, 101 XPOS_KEY_T = 4*KEY, XPOS_KEY_Y = 5*KEY, XPOS_KEY_U = 6*KEY, XPOS_KEY_I = 7*KEY, 102 XPOS_KEY_O = 8*KEY, XPOS_KEY_P = 9*KEY, 103 104 XPOS_KEY_A = 0, XPOS_KEY_S = KEY, XPOS_KEY_D = 2*KEY, XPOS_KEY_F = 3*KEY, 105 XPOS_KEY_G = 4*KEY, XPOS_KEY_H = 5*KEY, XPOS_KEY_J = 6*KEY, XPOS_KEY_K = 7*KEY, 106 XPOS_KEY_L = 8*KEY, XPOS_KEY_BACKSPACE = 9*KEY, 107 108 XPOS_KEY_ESCAPE = 0, XPOS_KEY_Z = KEY, XPOS_KEY_X = 2*KEY, XPOS_KEY_C = 3*KEY, 109 XPOS_KEY_V = 4*KEY, XPOS_KEY_B = 5*KEY, XPOS_KEY_N = 6*KEY, XPOS_KEY_M = 7*KEY, 110 XPOS_KEY_EQUAL = 8*KEY, XPOS_KEY_ENTER = 9*KEY, 111 112 XPOS_KEY_TAB = 0, XPOS_KEY_DOWNSHIFT = KEY, XPOS_KEY_BACKSLASH = 2*KEY, XPOS_KEY_APOSTROPHE = 3*KEY, 113 XPOS_KEY_COMMA = 4*KEY, XPOS_KEY_DOT = 5*KEY, XPOS_KEY_SLASH = 6*KEY, 114 XPOS_KEY_UP = 7*KEY+DIRKEY, XPOS_KEY_VOLUMEUP = 9*KEY, 115 116 XPOS_KEY_LEFTSHIFT = 0, XPOS_KEY_LEFTALT = KEY, XPOS_KEY_FN = 2*KEY, XPOS_KEY_SYM = 3*KEY, 117 XPOS_KEY_SPACE = 4*KEY, XPOS_KEY_QI = 5*KEY, XPOS_KEY_RIGHTCTRL = 6*KEY, XPOS_KEY_LEFT = 7*KEY, 118 XPOS_KEY_DOWN = 7*KEY+DIRKEY, XPOS_KEY_RIGHT = 7*KEY+2*DIRKEY, XPOS_KEY_VOLUMEDOWN = 9*KEY, 119 }; 120 121 enum { 122 YPOS_KEY_F1 = 0, YPOS_KEY_F2 = 0, YPOS_KEY_F3 = 0, YPOS_KEY_F4 = 0, 123 YPOS_KEY_F5 = 0, YPOS_KEY_F6 = 0, YPOS_KEY_F7 = 0, YPOS_KEY_F8 = 0, 124 125 YPOS_KEY_Q = 1, YPOS_KEY_W = 1, YPOS_KEY_E = 1, YPOS_KEY_R = 1, 126 YPOS_KEY_T = 1, YPOS_KEY_Y = 1, YPOS_KEY_U = 1, YPOS_KEY_I = 1, 127 YPOS_KEY_O = 1, YPOS_KEY_P = 1, 128 129 YPOS_KEY_A = 2, YPOS_KEY_S = 2, YPOS_KEY_D = 2, YPOS_KEY_F = 2, 130 YPOS_KEY_G = 2, YPOS_KEY_H = 2, YPOS_KEY_J = 2, YPOS_KEY_K = 2, 131 YPOS_KEY_L = 2, YPOS_KEY_BACKSPACE = 2, 132 133 YPOS_KEY_ESCAPE = 3, YPOS_KEY_Z = 3, YPOS_KEY_X = 3, YPOS_KEY_C = 3, 134 YPOS_KEY_V = 3, YPOS_KEY_B = 3, YPOS_KEY_N = 3, YPOS_KEY_M = 3, 135 YPOS_KEY_EQUAL = 3, YPOS_KEY_ENTER = 3, 136 137 YPOS_KEY_TAB = 4, YPOS_KEY_DOWNSHIFT = 4, YPOS_KEY_BACKSLASH = 4, YPOS_KEY_APOSTROPHE = 4, 138 YPOS_KEY_COMMA = 4, YPOS_KEY_DOT = 4, YPOS_KEY_SLASH = 4, 139 YPOS_KEY_UP = 4, YPOS_KEY_VOLUMEUP = 4, 140 141 YPOS_KEY_LEFTSHIFT = 5, YPOS_KEY_LEFTALT = 5, YPOS_KEY_FN = 5, YPOS_KEY_SYM = 5, 142 YPOS_KEY_SPACE = 5, YPOS_KEY_QI = 5, YPOS_KEY_RIGHTCTRL = 5, YPOS_KEY_LEFT = 5, 143 YPOS_KEY_DOWN = 5, YPOS_KEY_RIGHT = 5, YPOS_KEY_VOLUMEDOWN = 5, 144 }; 145 146 /* Keypad matrix mapping. */ 147 148 #define PHYS_KEY(X) {XPOS_KEY_##X, YPOS_KEY_##X, SIZE_KEY_##X} 149 #define PHYS_NULL {0, 0, 0} 150 151 static const uint32_t keypos[Jz4740_keypad_gpio_inputs_count][Jz4740_keypad_gpio_outputs_count][3] = { 152 153 {PHYS_KEY(F1), PHYS_KEY(F2), PHYS_KEY(F3), PHYS_KEY(F4), PHYS_KEY(F5), PHYS_KEY(F6), 154 PHYS_KEY(F7), PHYS_NULL}, 155 156 {PHYS_KEY(Q), PHYS_KEY(W), PHYS_KEY(E), PHYS_KEY(R), PHYS_KEY(T), PHYS_KEY(Y), 157 PHYS_KEY(U), PHYS_KEY(I)}, 158 159 {PHYS_KEY(A), PHYS_KEY(S), PHYS_KEY(D), PHYS_KEY(F), PHYS_KEY(G), PHYS_KEY(H), 160 PHYS_KEY(J), PHYS_KEY(K)}, 161 162 {PHYS_KEY(ESCAPE), PHYS_KEY(Z), PHYS_KEY(X), PHYS_KEY(C), PHYS_KEY(V), PHYS_KEY(B), 163 PHYS_KEY(N), PHYS_KEY(M)}, 164 165 {PHYS_KEY(TAB), PHYS_KEY(DOWNSHIFT) /* CAPSLOCK */, PHYS_KEY(BACKSLASH), 166 PHYS_KEY(APOSTROPHE), PHYS_KEY(COMMA), PHYS_KEY(DOT), PHYS_KEY(SLASH), PHYS_KEY(UP)}, 167 168 {PHYS_KEY(O), PHYS_KEY(L), PHYS_KEY(EQUAL), PHYS_KEY(SYM) /* RIGHTALT */, 169 PHYS_KEY(SPACE), PHYS_KEY(QI) /* F13 */, PHYS_KEY(RIGHTCTRL), PHYS_KEY(LEFT)}, 170 171 {PHYS_KEY(F8), PHYS_KEY(P), PHYS_KEY(BACKSPACE), PHYS_KEY(ENTER), PHYS_KEY(VOLUMEUP), 172 PHYS_KEY(VOLUMEDOWN), PHYS_KEY(DOWN), PHYS_KEY(RIGHT)}, 173 174 {PHYS_KEY(LEFTSHIFT), PHYS_KEY(LEFTALT), PHYS_KEY(FN), PHYS_NULL, PHYS_NULL, 175 PHYS_NULL, PHYS_NULL, PHYS_NULL} 176 }; 177 178 179 180 static uint32_t bitmask(uint32_t size) 181 { 182 return (1 << size) - 1; 183 } 184 185 static uint32_t truncate_channel(uint32_t value, uint32_t size) 186 { 187 return (value >> (8 - size)) & bitmask(size); 188 } 189 190 static void set_pixel(uint32_t pos, uint8_t bpp, uint32_t value) 191 { 192 if (bpp <= 8) *(uint8_t *) pos = value; 193 else if (bpp <= 16) *(uint16_t *) pos = value; 194 else *(uint32_t *) pos = value; 195 } 196 197 /* Show the state of a key on the display. */ 198 199 static void fill_rectangle(uint32_t x, uint32_t y, uint32_t w, uint32_t h, uint32_t rgb) 200 { 201 uint8_t bpp = l4re_video_bits_per_pixel(&fbi.pixel_info); 202 uint8_t bytes_per_pixel = fbi.pixel_info.bytes_per_pixel; 203 uint32_t bytes_per_line = fbi.bytes_per_line; 204 uint32_t pos; 205 uint32_t col, row; 206 207 rgb = (truncate_channel(rgb >> 16, fbi.pixel_info.r.size) << fbi.pixel_info.r.shift) | 208 (truncate_channel(rgb >> 8, fbi.pixel_info.g.size) << fbi.pixel_info.g.shift) | 209 (truncate_channel(rgb, fbi.pixel_info.b.size) << fbi.pixel_info.b.shift); 210 211 for (row = 0; row < h; row++) 212 { 213 pos = (uint32_t) fb + (y + row) * bytes_per_line + x * bytes_per_pixel; 214 215 for (col = 0; col < w; col++) 216 { 217 set_pixel(pos, bpp, rgb); 218 pos += bytes_per_pixel; 219 } 220 } 221 } 222 223 /* Show the keypad status on the display. */ 224 225 static void show_keypad(void) 226 { 227 uint32_t rowsize = fbi.height / ROWS, colsize; 228 uint8_t column, row; 229 uint32_t mask; 230 const uint32_t *pos; 231 232 for (column = 0; column < columns; column++) 233 234 for (row = 0, mask = 1 << (rows - 1); 235 row < rows; 236 row++, mask >>= 1) 237 { 238 /* Obtain the physical position. */ 239 240 pos = keypos[row][column]; 241 242 /* Obtain the width of the key. */ 243 244 colsize = (pos[2] * fbi.width) / WIDTH; 245 246 /* Plot the rectangle for the key. */ 247 248 fill_rectangle((pos[0] * fbi.width) / WIDTH, pos[1] * rowsize, colsize, rowsize, 249 keypad[column] & mask ? 0xffffff : 0); 250 } 251 252 /* Refresh the display. */ 253 254 l4re_util_video_goos_fb_refresh(&gfb, 0, 0, fbi.width, fbi.height); 255 } 256 257 258 259 int main(void) 260 { 261 l4_cap_idx_t keypad_server; 262 l4re_ds_t mem; 263 l4_msgtag_t tag; 264 265 if (l4re_util_video_goos_fb_setup_name(&gfb, "fb")) 266 return 1; 267 268 if (l4re_util_video_goos_fb_view_info(&gfb, &fbi)) 269 return 1; 270 271 if (!(fb = l4re_util_video_goos_fb_attach_buffer(&gfb))) 272 return 1; 273 274 /* Obtain a reference to the keypad. */ 275 276 keypad_server = l4re_env_get_cap("keypad"); 277 if (l4_is_invalid_cap(keypad_server)) return 1; 278 279 /* Obtain a capability for the keypad data. */ 280 281 mem = l4re_util_cap_alloc(); 282 if (l4_is_invalid_cap(mem)) return 1; 283 284 /* Obtain a reference to the keypad data. */ 285 286 l4_utcb_br()->bdr = 0; 287 l4_utcb_br()->br[0] = L4_RCV_ITEM_SINGLE_CAP | mem; 288 289 tag = l4_ipc_call(keypad_server, l4_utcb(), 290 l4_msgtag(0, 0, 0, 0), /* label zero, zero words, zero *sent* items */ 291 L4_IPC_NEVER); 292 293 if (l4_ipc_error(tag, l4_utcb())) return 1; 294 295 /* Attach the keypad data to a region in this task. */ 296 297 if (l4re_rm_attach(&keymem, l4re_ds_size(mem), L4RE_RM_SEARCH_ADDR, mem, 0, 298 L4_PAGESHIFT)) 299 return 1; 300 301 /* Show the keypad state. */ 302 303 keypad = (uint32_t *) keymem; 304 305 while (1) show_keypad(); 306 307 return 0; 308 }