Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 1 | /* vi: set sw=4 ts=4: */ |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 2 | /* |
| 3 | * Mini fbset implementation for busybox |
| 4 | * |
| 5 | * Copyright (C) 1999 by Randolph Chung <tausq@debian.org> |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of the GNU General Public License as published by |
| 9 | * the Free Software Foundation; either version 2 of the License, or |
| 10 | * (at your option) any later version. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, |
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 15 | * General Public License for more details. |
| 16 | * |
| 17 | * You should have received a copy of the GNU General Public License |
| 18 | * along with this program; if not, write to the Free Software |
| 19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| 20 | * |
| 21 | * This is a from-scratch implementation of fbset; but the de facto fbset |
| 22 | * implementation was a good reference. fbset (original) is released under |
| 23 | * the GPL, and is (c) 1995-1999 by: |
| 24 | * Geert Uytterhoeven (Geert.Uytterhoeven@cs.kuleuven.ac.be) |
| 25 | */ |
| 26 | |
| 27 | #include "internal.h" |
| 28 | #include <stdio.h> |
| 29 | #include <stdlib.h> |
| 30 | #include <unistd.h> |
| 31 | #include <fcntl.h> |
| 32 | #include <errno.h> |
| 33 | #include <ctype.h> |
| 34 | #include <sys/ioctl.h> |
| 35 | #include <linux/fb.h> |
Erik Andersen | 4d1d011 | 1999-12-17 18:44:15 +0000 | [diff] [blame] | 36 | #include <linux/version.h> |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 37 | |
| 38 | #define PERROR(ctx) do { perror(ctx); exit(1); } while(0) |
| 39 | |
Erik Andersen | 4d1d011 | 1999-12-17 18:44:15 +0000 | [diff] [blame] | 40 | #ifndef KERNEL_VERSION |
| 41 | #define KERNEL_VERSION(a,b,c) (((a) << 16) + ((b) << 8) + (c)) |
| 42 | #endif |
| 43 | |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 44 | #define DEFAULTFBDEV "/dev/fb0" |
| 45 | #define DEFAULTFBMODE "/etc/fb.modes" |
| 46 | |
| 47 | #define OPT_CHANGE 1 |
| 48 | #define OPT_INFO (1 << 1) |
| 49 | #define OPT_READMODE (1 << 2) |
| 50 | |
| 51 | #define CMD_HELP 0 |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 52 | #define CMD_FB 1 |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 53 | #define CMD_DB 2 |
| 54 | #define CMD_GEOMETRY 3 |
| 55 | #define CMD_TIMING 4 |
| 56 | #define CMD_ACCEL 5 |
| 57 | #define CMD_HSYNC 6 |
| 58 | #define CMD_VSYNC 7 |
| 59 | #define CMD_LACED 8 |
| 60 | #define CMD_DOUBLE 9 |
| 61 | /* #define CMD_XCOMPAT 10 */ |
| 62 | #define CMD_ALL 11 |
| 63 | #define CMD_INFO 12 |
| 64 | |
| 65 | #ifdef BB_FBSET_FANCY |
| 66 | #define CMD_XRES 13 |
| 67 | #define CMD_YRES 14 |
| 68 | #define CMD_VXRES 15 |
| 69 | #define CMD_VYRES 16 |
| 70 | #define CMD_DEPTH 17 |
| 71 | #define CMD_MATCH 18 |
| 72 | #define CMD_PIXCLOCK 19 |
| 73 | #define CMD_LEFT 20 |
| 74 | #define CMD_RIGHT 21 |
| 75 | #define CMD_UPPER 22 |
| 76 | #define CMD_LOWER 23 |
| 77 | #define CMD_HSLEN 24 |
| 78 | #define CMD_VSLEN 25 |
| 79 | #define CMD_CSYNC 26 |
| 80 | #define CMD_GSYNC 27 |
| 81 | #define CMD_EXTSYNC 28 |
| 82 | #define CMD_BCAST 29 |
| 83 | #define CMD_RGBA 30 |
| 84 | #define CMD_STEP 31 |
| 85 | #define CMD_MOVE 32 |
| 86 | #endif |
| 87 | |
| 88 | static unsigned int g_options = 0; |
| 89 | |
| 90 | struct cmdoptions_t { |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 91 | char *name; |
| 92 | unsigned char param_count; |
| 93 | unsigned char code; |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 94 | } g_cmdoptions[] = { |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 95 | { |
| 96 | "-h", 0, CMD_HELP}, { |
| 97 | "-fb", 1, CMD_FB}, { |
| 98 | "-db", 1, CMD_DB}, { |
| 99 | "-a", 0, CMD_ALL}, { |
| 100 | "-i", 0, CMD_INFO}, { |
| 101 | "-g", 5, CMD_GEOMETRY}, { |
| 102 | "-t", 7, CMD_TIMING}, { |
| 103 | "-accel", 1, CMD_ACCEL}, { |
| 104 | "-hsync", 1, CMD_HSYNC}, { |
| 105 | "-vsync", 1, CMD_VSYNC}, { |
| 106 | "-laced", 1, CMD_LACED}, { |
| 107 | "-double", 1, CMD_DOUBLE}, |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 108 | #ifdef BB_FBSET_FANCY |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 109 | { |
| 110 | "--help", 0, CMD_HELP}, { |
| 111 | "-all", 0, CMD_ALL}, { |
| 112 | "-xres", 1, CMD_XRES}, { |
| 113 | "-yres", 1, CMD_YRES}, { |
| 114 | "-vxres", 1, CMD_VXRES}, { |
| 115 | "-vyres", 1, CMD_VYRES}, { |
| 116 | "-depth", 1, CMD_DEPTH}, { |
| 117 | "-match", 0, CMD_MATCH}, { |
| 118 | "--geometry", 5, CMD_GEOMETRY}, { |
| 119 | "-pixclock", 1, CMD_PIXCLOCK}, { |
| 120 | "-left", 1, CMD_LEFT}, { |
| 121 | "-right", 1, CMD_RIGHT}, { |
| 122 | "-upper", 1, CMD_UPPER}, { |
| 123 | "-lower", 1, CMD_LOWER}, { |
| 124 | "-hslen", 1, CMD_HSLEN}, { |
| 125 | "-vslen", 1, CMD_VSLEN}, { |
| 126 | "--timings", 7, CMD_TIMING}, { |
| 127 | "-csync", 1, CMD_CSYNC}, { |
| 128 | "-gsync", 1, CMD_GSYNC}, { |
| 129 | "-extsync", 1, CMD_EXTSYNC}, { |
| 130 | "-bcast", 1, CMD_BCAST}, { |
| 131 | "-rgba", 1, CMD_RGBA}, { |
| 132 | "-step", 1, CMD_STEP}, { |
| 133 | "-move", 1, CMD_MOVE}, |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 134 | #endif |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 135 | { |
| 136 | 0, 0, 0} |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 137 | }; |
| 138 | |
| 139 | static int readmode(struct fb_var_screeninfo *base, const char *fn, |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 140 | const char *mode) |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 141 | { |
| 142 | #ifdef BB_FBSET_READMODE |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 143 | FILE *f; |
| 144 | char buf[256]; |
| 145 | char *p = buf; |
| 146 | |
| 147 | if ((f = fopen(fn, "r")) == NULL) |
| 148 | PERROR("readmode(fopen)"); |
| 149 | while (!feof(f)) { |
| 150 | fgets(buf, sizeof(buf), f); |
| 151 | if ((p = strstr(buf, "mode ")) || (p = strstr(buf, "mode\t"))) { |
| 152 | p += 5; |
| 153 | if ((p = strstr(buf, mode))) { |
| 154 | p += strlen(mode); |
| 155 | if (!isspace(*p) && (*p != 0) && (*p != '"') |
| 156 | && (*p != '\r') && (*p != '\n')) |
| 157 | continue; /* almost, but not quite */ |
| 158 | while (!feof(f)) { |
| 159 | fgets(buf, sizeof(buf), f); |
| 160 | if (!strstr(buf, "endmode")) |
| 161 | return 1; |
| 162 | } |
| 163 | } |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 164 | } |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 165 | } |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 166 | #else |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 167 | fprintf(stderr, |
| 168 | "W: mode reading was disabled on this copy of fbset; ignoring request\n"); |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 169 | #endif |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 170 | return 0; |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 171 | } |
| 172 | |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 173 | static void setmode(struct fb_var_screeninfo *base, |
| 174 | struct fb_var_screeninfo *set) |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 175 | { |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 176 | if ((int) set->xres > 0) |
| 177 | base->xres = set->xres; |
| 178 | if ((int) set->yres > 0) |
| 179 | base->yres = set->yres; |
| 180 | if ((int) set->xres_virtual > 0) |
| 181 | base->xres_virtual = set->xres_virtual; |
| 182 | if ((int) set->yres_virtual > 0) |
| 183 | base->yres_virtual = set->yres_virtual; |
| 184 | if ((int) set->bits_per_pixel > 0) |
| 185 | base->bits_per_pixel = set->bits_per_pixel; |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 186 | } |
| 187 | |
| 188 | static void showmode(struct fb_var_screeninfo *v) |
| 189 | { |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 190 | double drate = 0, hrate = 0, vrate = 0; |
| 191 | |
| 192 | if (v->pixclock) { |
| 193 | drate = 1e12 / v->pixclock; |
| 194 | hrate = |
| 195 | drate / (v->left_margin + v->xres + v->right_margin + |
| 196 | v->hsync_len); |
| 197 | vrate = |
| 198 | hrate / (v->upper_margin + v->yres + v->lower_margin + |
| 199 | v->vsync_len); |
| 200 | } |
| 201 | printf("\nmode \"%ux%u-%u\"\n", v->xres, v->yres, (int) (vrate + 0.5)); |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 202 | #ifdef BB_FBSET_FANCY |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 203 | printf("\t# D: %.3f MHz, H: %.3f kHz, V: %.3f Hz\n", drate / 1e6, |
| 204 | hrate / 1e3, vrate); |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 205 | #endif |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 206 | printf("\tgeometry %u %u %u %u %u\n", v->xres, v->yres, |
| 207 | v->xres_virtual, v->yres_virtual, v->bits_per_pixel); |
Erik Andersen | 4d1d011 | 1999-12-17 18:44:15 +0000 | [diff] [blame] | 208 | #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,2,0) |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 209 | printf("\ttimings %u %u %u %u %u %u %u\n", v->pixclock, v->left_margin, |
| 210 | v->right_margin, v->upper_margin, v->lower_margin, v->hsync_len, |
| 211 | v->vsync_len); |
| 212 | printf("\taccel %s\n", (v->accel_flags > 0 ? "true" : "false")); |
Erik Andersen | 4d1d011 | 1999-12-17 18:44:15 +0000 | [diff] [blame] | 213 | #else |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 214 | printf("\ttimings %lu %lu %lu %lu %lu %lu %lu\n", v->pixclock, |
| 215 | v->left_margin, v->right_margin, v->upper_margin, |
| 216 | v->lower_margin, v->hsync_len, v->vsync_len); |
Erik Andersen | 4d1d011 | 1999-12-17 18:44:15 +0000 | [diff] [blame] | 217 | #endif |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 218 | printf("\trgba %u/%u,%u/%u,%u/%u,%u/%u\n", v->red.length, |
| 219 | v->red.offset, v->green.length, v->green.offset, v->blue.length, |
| 220 | v->blue.offset, v->transp.length, v->transp.offset); |
| 221 | printf("endmode\n"); |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 222 | } |
| 223 | |
| 224 | static void fbset_usage(void) |
| 225 | { |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 226 | int i; |
| 227 | |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 228 | #ifndef STANDALONE |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 229 | fprintf(stderr, "BusyBox v%s (%s) multi-call binary -- GPL2\n\n", |
| 230 | BB_VER, BB_BT); |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 231 | #endif |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 232 | fprintf(stderr, "Usage: fbset [options] [mode]\n"); |
| 233 | fprintf(stderr, "\tThe following options are recognized:\n"); |
| 234 | for (i = 0; g_cmdoptions[i].name; i++) |
| 235 | fprintf(stderr, "\t\t%s\n", g_cmdoptions[i].name); |
| 236 | exit(-1); |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 237 | } |
| 238 | |
| 239 | #ifdef STANDALONE |
| 240 | int main(int argc, char **argv) |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 241 | #else |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 242 | extern int fbset_main(int argc, char **argv) |
| 243 | #endif |
| 244 | { |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 245 | struct fb_var_screeninfo var, varset; |
| 246 | int fh, i; |
| 247 | char *fbdev = DEFAULTFBDEV; |
| 248 | char *modefile = DEFAULTFBMODE; |
| 249 | char *thisarg, *mode = NULL; |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 250 | |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 251 | memset(&varset, 0xFF, sizeof(varset)); |
| 252 | |
| 253 | /* parse cmd args.... why do they have to make things so difficult? */ |
| 254 | argv++; |
| 255 | argc--; |
| 256 | for (; argc > 0 && (thisarg = *argv); argc--, argv++) { |
| 257 | for (i = 0; g_cmdoptions[i].name; i++) { |
| 258 | if (!strcmp(thisarg, g_cmdoptions[i].name)) { |
| 259 | if (argc - 1 < g_cmdoptions[i].param_count) |
| 260 | fbset_usage(); |
| 261 | switch (g_cmdoptions[i].code) { |
| 262 | case CMD_HELP: |
| 263 | fbset_usage(); |
| 264 | case CMD_FB: |
| 265 | fbdev = argv[1]; |
| 266 | break; |
| 267 | case CMD_DB: |
| 268 | modefile = argv[1]; |
| 269 | break; |
| 270 | case CMD_GEOMETRY: |
| 271 | varset.xres = strtoul(argv[1], 0, 0); |
| 272 | varset.yres = strtoul(argv[2], 0, 0); |
| 273 | varset.xres_virtual = strtoul(argv[3], 0, 0); |
| 274 | varset.yres_virtual = strtoul(argv[4], 0, 0); |
| 275 | varset.bits_per_pixel = strtoul(argv[5], 0, 0); |
| 276 | break; |
| 277 | case CMD_TIMING: |
| 278 | varset.pixclock = strtoul(argv[1], 0, 0); |
| 279 | varset.left_margin = strtoul(argv[2], 0, 0); |
| 280 | varset.right_margin = strtoul(argv[3], 0, 0); |
| 281 | varset.upper_margin = strtoul(argv[4], 0, 0); |
| 282 | varset.lower_margin = strtoul(argv[5], 0, 0); |
| 283 | varset.hsync_len = strtoul(argv[6], 0, 0); |
| 284 | varset.vsync_len = strtoul(argv[7], 0, 0); |
| 285 | break; |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 286 | #ifdef BB_FBSET_FANCY |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 287 | case CMD_XRES: |
| 288 | varset.xres = strtoul(argv[1], 0, 0); |
| 289 | break; |
| 290 | case CMD_YRES: |
| 291 | varset.yres = strtoul(argv[1], 0, 0); |
| 292 | break; |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 293 | #endif |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 294 | } |
| 295 | argc -= g_cmdoptions[i].param_count; |
| 296 | argv += g_cmdoptions[i].param_count; |
| 297 | break; |
| 298 | } |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 299 | } |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 300 | if (!g_cmdoptions[i].name) { |
| 301 | if (argc == 1) { |
| 302 | mode = *argv; |
| 303 | g_options |= OPT_READMODE; |
| 304 | } else { |
| 305 | fbset_usage(); |
| 306 | } |
| 307 | } |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 308 | } |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 309 | |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 310 | if ((fh = open(fbdev, O_RDONLY)) < 0) |
| 311 | PERROR("fbset(open)"); |
| 312 | if (ioctl(fh, FBIOGET_VSCREENINFO, &var)) |
| 313 | PERROR("fbset(ioctl)"); |
| 314 | if (g_options & OPT_READMODE) { |
| 315 | if (!readmode(&var, modefile, mode)) { |
| 316 | fprintf(stderr, "Unknown video mode `%s'\n", mode); |
| 317 | exit(1); |
| 318 | } |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 319 | } |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 320 | |
Erik Andersen | e49d5ec | 2000-02-08 19:58:47 +0000 | [diff] [blame^] | 321 | setmode(&var, &varset); |
| 322 | if (g_options & OPT_CHANGE) |
| 323 | if (ioctl(fh, FBIOPUT_VSCREENINFO, &var)) |
| 324 | PERROR("fbset(ioctl)"); |
| 325 | showmode(&var); |
| 326 | close(fh); |
| 327 | |
| 328 | return (TRUE); |
Erik Andersen | 1c5b258 | 1999-12-16 20:59:36 +0000 | [diff] [blame] | 329 | } |