| paul@0 | 1 | /* |
| paul@0 | 2 | * Display the keypad matrix using the specified dimensions. |
| paul@0 | 3 | * |
| paul@0 | 4 | * (c) 2018 Paul Boddie <paul@boddie.org.uk> |
| paul@0 | 5 | * |
| paul@0 | 6 | * This program is free software; you can redistribute it and/or |
| paul@0 | 7 | * modify it under the terms of the GNU General Public License as |
| paul@0 | 8 | * published by the Free Software Foundation; either version 2 of |
| paul@0 | 9 | * the License, or (at your option) any later version. |
| paul@0 | 10 | * |
| paul@0 | 11 | * This program is distributed in the hope that it will be useful, |
| paul@0 | 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| paul@0 | 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| paul@0 | 14 | * GNU General Public License for more details. |
| paul@0 | 15 | * |
| paul@0 | 16 | * You should have received a copy of the GNU General Public License |
| paul@0 | 17 | * along with this program; if not, write to the Free Software |
| paul@0 | 18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, |
| paul@0 | 19 | * Boston, MA 02110-1301, USA |
| paul@0 | 20 | */ |
| paul@0 | 21 | |
| paul@0 | 22 | #include <l4/devices/keypad-client.h> |
| paul@0 | 23 | |
| paul@0 | 24 | #include <l4/cxx/ipc_server> |
| paul@0 | 25 | #include <l4/re/dataspace> |
| paul@0 | 26 | #include <l4/re/env> |
| paul@0 | 27 | #include <l4/re/rm> |
| paul@0 | 28 | #include <l4/re/util/cap_alloc> |
| paul@0 | 29 | |
| paul@0 | 30 | #include <l4/re/c/util/video/goos_fb.h> |
| paul@0 | 31 | #include <l4/re/c/video/view.h> |
| paul@0 | 32 | |
| paul@0 | 33 | #include <l4/util/util.h> |
| paul@0 | 34 | #include <stdio.h> |
| paul@0 | 35 | #include <unistd.h> |
| paul@0 | 36 | #include <stdint.h> |
| paul@0 | 37 | #include <stdlib.h> |
| paul@0 | 38 | |
| paul@0 | 39 | /* Video abstractions. */ |
| paul@0 | 40 | |
| paul@0 | 41 | static l4re_util_video_goos_fb_t gfb; |
| paul@0 | 42 | static l4re_video_view_info_t fbi; |
| paul@0 | 43 | static void *fb; |
| paul@0 | 44 | |
| paul@0 | 45 | /* Keypad status and dimensions. */ |
| paul@0 | 46 | |
| paul@0 | 47 | uint32_t *keypad = 0; |
| paul@0 | 48 | void *keymem = 0; |
| paul@0 | 49 | int columns, rows; |
| paul@0 | 50 | |
| paul@0 | 51 | |
| paul@0 | 52 | |
| paul@0 | 53 | static uint32_t bitmask(uint32_t size) |
| paul@0 | 54 | { |
| paul@0 | 55 | return (1 << size) - 1; |
| paul@0 | 56 | } |
| paul@0 | 57 | |
| paul@0 | 58 | static uint32_t truncate_channel(uint32_t value, uint32_t size) |
| paul@0 | 59 | { |
| paul@0 | 60 | return (value >> (8 - size)) & bitmask(size); |
| paul@0 | 61 | } |
| paul@0 | 62 | |
| paul@0 | 63 | static void set_pixel(uint32_t pos, uint8_t bpp, uint32_t value) |
| paul@0 | 64 | { |
| paul@0 | 65 | if (bpp <= 8) *(uint8_t *) pos = value; |
| paul@0 | 66 | else if (bpp <= 16) *(uint16_t *) pos = value; |
| paul@0 | 67 | else *(uint32_t *) pos = value; |
| paul@0 | 68 | } |
| paul@0 | 69 | |
| paul@0 | 70 | /* Show the state of a key on the display. */ |
| paul@0 | 71 | |
| paul@0 | 72 | static void show_keystate(uint32_t x, uint32_t y, uint32_t w, uint32_t h, uint32_t rgb) |
| paul@0 | 73 | { |
| paul@0 | 74 | uint8_t bpp = l4re_video_bits_per_pixel(&fbi.pixel_info); |
| paul@0 | 75 | uint8_t bytes_per_pixel = fbi.pixel_info.bytes_per_pixel; |
| paul@0 | 76 | uint32_t bytes_per_line = fbi.bytes_per_line; |
| paul@0 | 77 | uint32_t pos; |
| paul@0 | 78 | uint32_t col, row; |
| paul@0 | 79 | |
| paul@0 | 80 | rgb = (truncate_channel(rgb >> 16, fbi.pixel_info.r.size) << fbi.pixel_info.r.shift) | |
| paul@0 | 81 | (truncate_channel(rgb >> 8, fbi.pixel_info.g.size) << fbi.pixel_info.g.shift) | |
| paul@0 | 82 | (truncate_channel(rgb, fbi.pixel_info.b.size) << fbi.pixel_info.b.shift); |
| paul@0 | 83 | |
| paul@0 | 84 | for (row = 0; row < h; row++) |
| paul@0 | 85 | { |
| paul@0 | 86 | pos = (uint32_t) fb + (y + row) * bytes_per_line + x * bytes_per_pixel; |
| paul@0 | 87 | |
| paul@0 | 88 | for (col = 0; col < w; col++) |
| paul@0 | 89 | { |
| paul@0 | 90 | set_pixel(pos, bpp, rgb); |
| paul@0 | 91 | pos += bytes_per_pixel; |
| paul@0 | 92 | } |
| paul@0 | 93 | } |
| paul@0 | 94 | } |
| paul@0 | 95 | |
| paul@0 | 96 | /* Show the keypad status on the display. */ |
| paul@0 | 97 | |
| paul@0 | 98 | static void show_keypad(void) |
| paul@0 | 99 | { |
| paul@0 | 100 | uint32_t colsize = fbi.width / columns, |
| paul@0 | 101 | rowsize = fbi.height / rows; |
| paul@0 | 102 | uint8_t column, row; |
| paul@0 | 103 | uint32_t mask; |
| paul@0 | 104 | |
| paul@0 | 105 | for (column = 0; column < columns; column++) |
| paul@0 | 106 | |
| paul@0 | 107 | for (row = 0, mask = 1 << (rows - 1); |
| paul@0 | 108 | row < rows; |
| paul@0 | 109 | row++, mask >>= 1) |
| paul@0 | 110 | |
| paul@0 | 111 | show_keystate(column * colsize, row * rowsize, colsize, rowsize, |
| paul@0 | 112 | keypad[column] & mask ? 0xffffff : 0); |
| paul@0 | 113 | |
| paul@0 | 114 | /* Refresh the display. */ |
| paul@0 | 115 | |
| paul@0 | 116 | l4re_util_video_goos_fb_refresh(&gfb, 0, 0, fbi.width, fbi.height); |
| paul@0 | 117 | } |
| paul@0 | 118 | |
| paul@0 | 119 | |
| paul@0 | 120 | |
| paul@0 | 121 | int main(int argc, char *argv[]) |
| paul@0 | 122 | { |
| paul@0 | 123 | L4::Cap<Keypad_device_interface> keypad_server; |
| paul@0 | 124 | L4::Cap<L4Re::Dataspace> mem; |
| paul@0 | 125 | |
| paul@0 | 126 | /* Obtain the keypad matrix dimensions. */ |
| paul@0 | 127 | |
| paul@0 | 128 | if (argc < 3) |
| paul@0 | 129 | return 1; |
| paul@0 | 130 | |
| paul@0 | 131 | columns = atoi(argv[1]); |
| paul@0 | 132 | rows = atoi(argv[2]); |
| paul@0 | 133 | |
| paul@0 | 134 | if (l4re_util_video_goos_fb_setup_name(&gfb, "fb")) |
| paul@0 | 135 | return 1; |
| paul@0 | 136 | |
| paul@0 | 137 | if (l4re_util_video_goos_fb_view_info(&gfb, &fbi)) |
| paul@0 | 138 | return 1; |
| paul@0 | 139 | |
| paul@0 | 140 | if (!(fb = l4re_util_video_goos_fb_attach_buffer(&gfb))) |
| paul@0 | 141 | return 1; |
| paul@0 | 142 | |
| paul@0 | 143 | /* Obtain a reference to the keypad. */ |
| paul@0 | 144 | |
| paul@0 | 145 | keypad_server = L4Re::Env::env()->get_cap<Keypad_device_interface>("keypad"); |
| paul@0 | 146 | if (!keypad_server.is_valid()) return 1; |
| paul@0 | 147 | |
| paul@0 | 148 | /* Obtain a capability for the keypad data. */ |
| paul@0 | 149 | |
| paul@0 | 150 | mem = L4Re::Util::cap_alloc.alloc<L4Re::Dataspace>(); |
| paul@0 | 151 | if (!mem.is_valid()) return 1; |
| paul@0 | 152 | |
| paul@0 | 153 | /* Obtain a reference to the keypad data. */ |
| paul@0 | 154 | |
| paul@0 | 155 | if (keypad_server->get_keypad_data(mem)) return 1; |
| paul@0 | 156 | |
| paul@0 | 157 | /* Attach the keypad data to a region in this task. */ |
| paul@0 | 158 | |
| paul@0 | 159 | if (L4Re::Env::env()->rm()->attach(&keymem, mem->size(), L4Re::Rm::Search_addr, |
| paul@0 | 160 | L4::Ipc::make_cap_rw(mem))) |
| paul@0 | 161 | return 1; |
| paul@0 | 162 | |
| paul@0 | 163 | /* Show the keypad state. */ |
| paul@0 | 164 | |
| paul@0 | 165 | keypad = (uint32_t *) keymem; |
| paul@0 | 166 | |
| paul@0 | 167 | while (1) show_keypad(); |
| paul@0 | 168 | |
| paul@0 | 169 | return 0; |
| paul@0 | 170 | } |
