shrink the code a bit
[oweals/busybox.git] / util-linux / fbset.c
index f20c284aa3c1e5f9ce11e2c17efe662be2de9695..49435c22e8a856041ec828f9fea7b269c0f67bf7 100644 (file)
  *
  * This is a from-scratch implementation of fbset; but the de facto fbset
  * implementation was a good reference. fbset (original) is released under
- * the GPL, and is (c) 1995-1999 by: 
+ * the GPL, and is (c) 1995-1999 by:
  *     Geert Uytterhoeven (Geert.Uytterhoeven@cs.kuleuven.ac.be)
  */
 
-#include "busybox.h"
 #include <stdio.h>
 #include <stdlib.h>
 #include <unistd.h>
 #include <errno.h>
 #include <ctype.h>
 #include <string.h>
+#include <stdint.h>
 #include <sys/ioctl.h>
+#include "busybox.h"
 
-#define DEFAULTFBDEV  "/dev/fb0"
+#define DEFAULTFBDEV  FB_0
 #define DEFAULTFBMODE "/etc/fb.modes"
 
 static const int OPT_CHANGE   = (1 << 0);
@@ -42,7 +43,6 @@ static const int OPT_INFO     = (1 << 1);
 static const int OPT_READMODE = (1 << 2);
 
 enum {
-       CMD_HELP = 0,
        CMD_FB = 1,
        CMD_DB = 2,
        CMD_GEOMETRY = 3,
@@ -52,12 +52,12 @@ enum {
        CMD_VSYNC = 7,
        CMD_LACED = 8,
        CMD_DOUBLE = 9,
-/*     CMD_XCOMPAT =     10, */
+/*     CMD_XCOMPAT =     10, */
        CMD_ALL = 11,
        CMD_INFO = 12,
        CMD_CHANGE = 13,
 
-#ifdef BB_FEATURE_FBSET_FANCY
+#ifdef CONFIG_FEATURE_FBSET_FANCY
        CMD_XRES = 100,
        CMD_YRES = 101,
        CMD_VXRES = 102,
@@ -86,59 +86,57 @@ static unsigned int g_options = 0;
 /* Stuff stolen from the kernel's fb.h */
 static const int FBIOGET_VSCREENINFO = 0x4600;
 static const int FBIOPUT_VSCREENINFO = 0x4601;
-#define __u32                  unsigned int
 struct fb_bitfield {
-       __u32 offset;                   /* beginning of bitfield        */
-       __u32 length;                   /* length of bitfield           */
-       __u32 msb_right;                /* != 0 : Most significant bit is */ 
-                                       /* right */ 
+       uint32_t offset;                        /* beginning of bitfield        */
+       uint32_t length;                        /* length of bitfield           */
+       uint32_t msb_right;             /* != 0 : Most significant bit is */
+                                       /* right */
 };
 struct fb_var_screeninfo {
-       __u32 xres;                     /* visible resolution           */
-       __u32 yres;
-       __u32 xres_virtual;             /* virtual resolution           */
-       __u32 yres_virtual;
-       __u32 xoffset;                  /* offset from virtual to visible */
-       __u32 yoffset;                  /* resolution                   */
+       uint32_t xres;                  /* visible resolution           */
+       uint32_t yres;
+       uint32_t xres_virtual;          /* virtual resolution           */
+       uint32_t yres_virtual;
+       uint32_t xoffset;                       /* offset from virtual to visible */
+       uint32_t yoffset;                       /* resolution                   */
 
-       __u32 bits_per_pixel;           /* guess what                   */
-       __u32 grayscale;                /* != 0 Graylevels instead of colors */
+       uint32_t bits_per_pixel;                /* guess what                   */
+       uint32_t grayscale;             /* != 0 Graylevels instead of colors */
 
        struct fb_bitfield red;         /* bitfield in fb mem if true color, */
        struct fb_bitfield green;       /* else only length is significant */
        struct fb_bitfield blue;
-       struct fb_bitfield transp;      /* transparency                 */      
+       struct fb_bitfield transp;      /* transparency                 */
 
-       __u32 nonstd;                   /* != 0 Non standard pixel format */
+       uint32_t nonstd;                        /* != 0 Non standard pixel format */
 
-       __u32 activate;                 /* see FB_ACTIVATE_*            */
+       uint32_t activate;                      /* see FB_ACTIVATE_*            */
 
-       __u32 height;                   /* height of picture in mm    */
-       __u32 width;                    /* width of picture in mm     */
+       uint32_t height;                        /* height of picture in mm    */
+       uint32_t width;                 /* width of picture in mm     */
 
-       __u32 accel_flags;              /* acceleration flags (hints)   */
+       uint32_t accel_flags;           /* acceleration flags (hints)   */
 
        /* Timing: All values in pixclocks, except pixclock (of course) */
-       __u32 pixclock;                 /* pixel clock in ps (pico seconds) */
-       __u32 left_margin;              /* time from sync to picture    */
-       __u32 right_margin;             /* time from picture to sync    */
-       __u32 upper_margin;             /* time from sync to picture    */
-       __u32 lower_margin;
-       __u32 hsync_len;                /* length of horizontal sync    */
-       __u32 vsync_len;                /* length of vertical sync      */
-       __u32 sync;                     /* see FB_SYNC_*                */
-       __u32 vmode;                    /* see FB_VMODE_*               */
-       __u32 reserved[6];              /* Reserved for future compatibility */
+       uint32_t pixclock;                      /* pixel clock in ps (pico seconds) */
+       uint32_t left_margin;           /* time from sync to picture    */
+       uint32_t right_margin;          /* time from picture to sync    */
+       uint32_t upper_margin;          /* time from sync to picture    */
+       uint32_t lower_margin;
+       uint32_t hsync_len;             /* length of horizontal sync    */
+       uint32_t vsync_len;             /* length of vertical sync      */
+       uint32_t sync;                  /* see FB_SYNC_*                */
+       uint32_t vmode;                 /* see FB_VMODE_*               */
+       uint32_t reserved[6];           /* Reserved for future compatibility */
 };
 
 
-struct cmdoptions_t {
-       char *name;
-       unsigned char param_count;
-       unsigned char code;
+static const struct cmdoptions_t {
+       const char *name;
+       const unsigned char param_count;
+       const unsigned char code;
 } g_cmdoptions[] = {
        {
-       "-h", 0, CMD_HELP}, {
        "-fb", 1, CMD_FB}, {
        "-db", 1, CMD_DB}, {
        "-a", 0, CMD_ALL}, {
@@ -150,10 +148,8 @@ struct cmdoptions_t {
        "-vsync", 1, CMD_VSYNC}, {
        "-laced", 1, CMD_LACED}, {
        "-double", 1, CMD_DOUBLE}, {
-       "-help", 0, CMD_HELP}, {
        "-n", 0, CMD_CHANGE}, {
-#ifdef BB_FEATURE_FBSET_FANCY
-       "-help", 0, CMD_HELP}, {
+#ifdef CONFIG_FEATURE_FBSET_FANCY
        "-all", 0, CMD_ALL}, {
        "-xres", 1, CMD_XRES}, {
        "-yres", 1, CMD_YRES}, {
@@ -181,7 +177,7 @@ struct cmdoptions_t {
        0, 0, 0}
 };
 
-#ifdef BB_FEATURE_FBSET_READMODE
+#ifdef CONFIG_FEATURE_FBSET_READMODE
 /* taken from linux/fb.h */
 static const int FB_VMODE_INTERLACED = 1;      /* interlaced   */
 static const int FB_VMODE_DOUBLE = 2;  /* double scan */
@@ -193,13 +189,12 @@ static const int FB_SYNC_COMP_HIGH_ACT = 8;       /* composite sync high active   */
 static int readmode(struct fb_var_screeninfo *base, const char *fn,
                                        const char *mode)
 {
-#ifdef BB_FEATURE_FBSET_READMODE
+#ifdef CONFIG_FEATURE_FBSET_READMODE
        FILE *f;
        char buf[256];
        char *p = buf;
 
-       if ((f = fopen(fn, "r")) == NULL)
-               perror_msg_and_die("readmode(fopen)");
+       f = bb_xfopen(fn, "r");
        while (!feof(f)) {
                fgets(buf, sizeof(buf), f);
                if ((p = strstr(buf, "mode ")) || (p = strstr(buf, "mode\t"))) {
@@ -212,71 +207,71 @@ static int readmode(struct fb_var_screeninfo *base, const char *fn,
                                while (!feof(f)) {
                                        fgets(buf, sizeof(buf), f);
 
-                    if ((p = strstr(buf, "geometry "))) {
-                        p += 9;
-
-                        sscanf(p, "%d %d %d %d %d", 
-                                &(base->xres), &(base->yres), 
-                                &(base->xres_virtual), &(base->yres_virtual), 
-                                &(base->bits_per_pixel));
-                    } else if ((p = strstr(buf, "timings "))) {
-                        p += 8;
-                        
-                        sscanf(p, "%d %d %d %d %d %d %d",
-                                &(base->pixclock),
-                                &(base->left_margin), &(base->right_margin),
-                                &(base->upper_margin), &(base->lower_margin),
-                                &(base->hsync_len), &(base->vsync_len));
-                    } else if ((p = strstr(buf, "laced "))) {
-                        p += 6;
-
-                        if (strstr(buf, "false")) {
-                            base->vmode &= ~FB_VMODE_INTERLACED;
-                        } else {
-                            base->vmode |= FB_VMODE_INTERLACED;
-                        }
-                    } else if ((p = strstr(buf, "double "))) {
-                        p += 7;
-
-                        if (strstr(buf, "false")) {
-                            base->vmode &= ~FB_VMODE_DOUBLE;
-                        } else {
-                            base->vmode |= FB_VMODE_DOUBLE;
-                        }
-                    } else if ((p = strstr(buf, "vsync "))) {
-                        p += 6;
-
-                        if (strstr(buf, "low")) {
-                            base->sync &= ~FB_SYNC_VERT_HIGH_ACT;
-                        } else {
-                            base->sync |= FB_SYNC_VERT_HIGH_ACT;
-                        }
-                    } else if ((p = strstr(buf, "hsync "))) {
-                        p += 6;
-
-                        if (strstr(buf, "low")) {
-                            base->sync &= ~FB_SYNC_HOR_HIGH_ACT;
-                        } else {
-                            base->sync |= FB_SYNC_HOR_HIGH_ACT;
-                        }
-                    } else if ((p = strstr(buf, "csync "))) {
-                        p += 6;
-
-                        if (strstr(buf, "low")) {
-                            base->sync &= ~FB_SYNC_COMP_HIGH_ACT;
-                        } else {
-                            base->sync |= FB_SYNC_COMP_HIGH_ACT;
-                        }
-                    } else if ((p = strstr(buf, "extsync "))) {
-                        p += 8;
-
-                        if (strstr(buf, "false")) {
-                            base->sync &= ~FB_SYNC_EXT;
-                        } else {
-                            base->sync |= FB_SYNC_EXT;
-                        }
-                    }
-                    
+                   if ((p = strstr(buf, "geometry "))) {
+                       p += 9;
+
+                       sscanf(p, "%d %d %d %d %d",
+                               &(base->xres), &(base->yres),
+                               &(base->xres_virtual), &(base->yres_virtual),
+                               &(base->bits_per_pixel));
+                   } else if ((p = strstr(buf, "timings "))) {
+                       p += 8;
+
+                       sscanf(p, "%d %d %d %d %d %d %d",
+                               &(base->pixclock),
+                               &(base->left_margin), &(base->right_margin),
+                               &(base->upper_margin), &(base->lower_margin),
+                               &(base->hsync_len), &(base->vsync_len));
+                   } else if ((p = strstr(buf, "laced "))) {
+                       p += 6;
+
+                       if (strstr(buf, "false")) {
+                           base->vmode &= ~FB_VMODE_INTERLACED;
+                       } else {
+                           base->vmode |= FB_VMODE_INTERLACED;
+                       }
+                   } else if ((p = strstr(buf, "double "))) {
+                       p += 7;
+
+                       if (strstr(buf, "false")) {
+                           base->vmode &= ~FB_VMODE_DOUBLE;
+                       } else {
+                           base->vmode |= FB_VMODE_DOUBLE;
+                       }
+                   } else if ((p = strstr(buf, "vsync "))) {
+                       p += 6;
+
+                       if (strstr(buf, "low")) {
+                           base->sync &= ~FB_SYNC_VERT_HIGH_ACT;
+                       } else {
+                           base->sync |= FB_SYNC_VERT_HIGH_ACT;
+                       }
+                   } else if ((p = strstr(buf, "hsync "))) {
+                       p += 6;
+
+                       if (strstr(buf, "low")) {
+                           base->sync &= ~FB_SYNC_HOR_HIGH_ACT;
+                       } else {
+                           base->sync |= FB_SYNC_HOR_HIGH_ACT;
+                       }
+                   } else if ((p = strstr(buf, "csync "))) {
+                       p += 6;
+
+                       if (strstr(buf, "low")) {
+                           base->sync &= ~FB_SYNC_COMP_HIGH_ACT;
+                       } else {
+                           base->sync |= FB_SYNC_COMP_HIGH_ACT;
+                       }
+                   } else if ((p = strstr(buf, "extsync "))) {
+                       p += 8;
+
+                       if (strstr(buf, "false")) {
+                           base->sync &= ~FB_SYNC_EXT;
+                       } else {
+                           base->sync |= FB_SYNC_EXT;
+                       }
+                   }
+
                                        if (strstr(buf, "endmode"))
                                                return 1;
                                }
@@ -284,12 +279,12 @@ static int readmode(struct fb_var_screeninfo *base, const char *fn,
                }
        }
 #else
-       error_msg( "mode reading not compiled in");
+       bb_error_msg( "mode reading not compiled in");
 #endif
        return 0;
 }
 
-static void setmode(struct fb_var_screeninfo *base,
+static inline void setmode(struct fb_var_screeninfo *base,
                                        struct fb_var_screeninfo *set)
 {
        if ((int) set->xres > 0)
@@ -304,7 +299,7 @@ static void setmode(struct fb_var_screeninfo *base,
                base->bits_per_pixel = set->bits_per_pixel;
 }
 
-static void showmode(struct fb_var_screeninfo *v)
+static inline void showmode(struct fb_var_screeninfo *v)
 {
        double drate = 0, hrate = 0, vrate = 0;
 
@@ -317,41 +312,21 @@ static void showmode(struct fb_var_screeninfo *v)
                        hrate / (v->upper_margin + v->yres + v->lower_margin +
                                         v->vsync_len);
        }
-       printf("\nmode \"%ux%u-%u\"\n", v->xres, v->yres, (int) (vrate + 0.5));
-#ifdef BB_FEATURE_FBSET_FANCY
-       printf("\t# D: %.3f MHz, H: %.3f kHz, V: %.3f Hz\n", drate / 1e6,
-                  hrate / 1e3, vrate);
+       printf("\nmode \"%ux%u-%u\"\n"
+#ifdef CONFIG_FEATURE_FBSET_FANCY
+       "\t# D: %.3f MHz, H: %.3f kHz, V: %.3f Hz\n"
+#endif
+       "\tgeometry %u %u %u %u %u\n\ttimings %u %u %u %u %u %u %u\n\taccel %s\n\trgba %u/%u,%u/%u,%u/%u,%u/%u\nendmode\n\n",
+                  v->xres, v->yres, (int) (vrate + 0.5),
+#ifdef CONFIG_FEATURE_FBSET_FANCY
+                  drate / 1e6, hrate / 1e3, vrate,
 #endif
-       printf("\tgeometry %u %u %u %u %u\n", v->xres, v->yres,
-                  v->xres_virtual, v->yres_virtual, v->bits_per_pixel);
-       printf("\ttimings %u %u %u %u %u %u %u\n", v->pixclock, v->left_margin,
+                  v->xres, v->yres, v->xres_virtual, v->yres_virtual,
+                  v->bits_per_pixel, v->pixclock, v->left_margin,
                   v->right_margin, v->upper_margin, v->lower_margin, v->hsync_len,
-                  v->vsync_len);
-       printf("\taccel %s\n", (v->accel_flags > 0 ? "true" : "false"));
-       printf("\trgba %u/%u,%u/%u,%u/%u,%u/%u\n", v->red.length,
+                  v->vsync_len, (v->accel_flags > 0 ? "true" : "false"), v->red.length,
                   v->red.offset, v->green.length, v->green.offset, v->blue.length,
                   v->blue.offset, v->transp.length, v->transp.offset);
-       printf("endmode\n\n");
-}
-
-static void fbset_usage(void)
-{
-#ifndef BB_FEATURE_TRIVIAL_HELP
-       int i;
-#endif
-
-#ifndef STANDALONE
-       fprintf(stderr, "BusyBox v%s (%s) multi-call binary -- GPL2\n\n",
-                       BB_VER, BB_BT);
-#endif
-       fprintf(stderr, "Usage: fbset [options] [mode]\n");
-#ifndef BB_FEATURE_TRIVIAL_HELP
-       fprintf(stderr, "\nShows and modifies frame buffer device settings\n\n");
-       fprintf(stderr, "The following options are recognized:\n");
-       for (i = 0; g_cmdoptions[i].name; i++)
-               fprintf(stderr, "\t%s\n", g_cmdoptions[i].name);
-#endif
-       exit(-1);
 }
 
 #ifdef STANDALONE
@@ -375,10 +350,8 @@ extern int fbset_main(int argc, char **argv)
                for (i = 0; g_cmdoptions[i].name; i++) {
                        if (!strcmp(thisarg, g_cmdoptions[i].name)) {
                                if (argc - 1 < g_cmdoptions[i].param_count)
-                                       fbset_usage();
+                                       bb_show_usage();
                                switch (g_cmdoptions[i].code) {
-                               case CMD_HELP:
-                                       fbset_usage();
                                case CMD_FB:
                                        fbdev = argv[1];
                                        break;
@@ -401,16 +374,19 @@ extern int fbset_main(int argc, char **argv)
                                        varset.hsync_len = strtoul(argv[6], 0, 0);
                                        varset.vsync_len = strtoul(argv[7], 0, 0);
                                        break;
-                case CMD_CHANGE:
-                    g_options |= OPT_CHANGE;
-                    break;
-#ifdef BB_FEATURE_FBSET_FANCY
+               case CMD_CHANGE:
+                   g_options |= OPT_CHANGE;
+                   break;
+#ifdef CONFIG_FEATURE_FBSET_FANCY
                                case CMD_XRES:
                                        varset.xres = strtoul(argv[1], 0, 0);
                                        break;
                                case CMD_YRES:
                                        varset.yres = strtoul(argv[1], 0, 0);
                                        break;
+                          case CMD_DEPTH:
+                                       varset.bits_per_pixel = strtoul(argv[1], 0, 0);
+                                       break;
 #endif
                                }
                                argc -= g_cmdoptions[i].param_count;
@@ -423,18 +399,18 @@ extern int fbset_main(int argc, char **argv)
                                mode = *argv;
                                g_options |= OPT_READMODE;
                        } else {
-                               fbset_usage();
+                               bb_show_usage();
                        }
                }
        }
 
        if ((fh = open(fbdev, O_RDONLY)) < 0)
-               perror_msg_and_die("fbset(open)");
+               bb_perror_msg_and_die("fbset(open)");
        if (ioctl(fh, FBIOGET_VSCREENINFO, &var))
-               perror_msg_and_die("fbset(ioctl)");
+               bb_perror_msg_and_die("fbset(ioctl)");
        if (g_options & OPT_READMODE) {
                if (!readmode(&var, modefile, mode)) {
-                       error_msg("Unknown video mode `%s'", mode);
+                       bb_error_msg("Unknown video mode `%s'", mode);
                        return EXIT_FAILURE;
                }
        }
@@ -442,7 +418,7 @@ extern int fbset_main(int argc, char **argv)
        setmode(&var, &varset);
        if (g_options & OPT_CHANGE)
                if (ioctl(fh, FBIOPUT_VSCREENINFO, &var))
-                       perror_msg_and_die("fbset(ioctl)");
+                       bb_perror_msg_and_die("fbset(ioctl)");
        showmode(&var);
        /* Don't close the file, as exiting will take care of that */
        /* close(fh); */