drivers/video/videomodes.c

   1 /*
   2  * (C) Copyright 2004
   3  * Pierre Aubert, Staubli Faverges , <p.aubert@staubli.com>
   4  * Copyright 2011 Freescale Semiconductor, Inc.
   5  *
   6  * See file CREDITS for list of people who contributed to this
   7  * project.
   8  *
   9  * This program is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU General Public License as
  11  * published by the Free Software Foundation; either version 2 of
  12  * the License, or (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  22  * MA 02111-1307 USA
  23  */
  24
  25 /************************************************************************
  26   Get Parameters for the video mode:
  27   The default video mode can be defined in CONFIG_SYS_DEFAULT_VIDEO_MODE.
  28   If undefined, default video mode is set to 0x301
  29   Parameters can be set via the variable "videomode" in the environment.
  30   2 diferent ways are possible:
  31   "videomode=301"   - 301 is a hexadecimal number describing the VESA
  32                       mode. Following modes are implemented:
  33
  34                       Colors    640x480 800x600 1024x768 1152x864 1280x1024
  35                      --------+---------------------------------------------
  36                       8 bits |  0x301   0x303    0x305    0x161     0x307
  37                      15 bits |  0x310   0x313    0x316    0x162     0x319
  38                      16 bits |  0x311   0x314    0x317    0x163     0x31A
  39                      24 bits |  0x312   0x315    0x318      ?       0x31B
  40                      --------+---------------------------------------------
  41   "videomode=bootargs"
  42                    - the parameters are parsed from the bootargs.
  43                       The format is "NAME:VALUE,NAME:VALUE" etc.
  44                       Ex.:
  45                       "bootargs=video=ctfb:x:800,y:600,depth:16,pclk:25000"
  46                       Parameters not included in the list will be taken from
  47                       the default mode, which is one of the following:
  48                       mode:0  640x480x24
  49                       mode:1  800x600x16
  50                       mode:2  1024x768x8
  51                       mode:3  960x720x24
  52                       mode:4  1152x864x16
  53                       mode:5  1280x1024x8
  54
  55                       if "mode" is not provided within the parameter list,
  56                       mode:0 is assumed.
  57                       Following parameters are supported:
  58                       x       xres = visible resolution horizontal
  59                       y       yres = visible resolution vertical
  60                       pclk    pixelclocks in pico sec
  61                       le      left_marging time from sync to picture in pixelclocks
  62                       ri      right_marging time from picture to sync in pixelclocks
  63                       up      upper_margin time from sync to picture
  64                       lo      lower_margin
  65                       hs      hsync_len length of horizontal sync
  66                       vs      vsync_len length of vertical sync
  67                       sync    see FB_SYNC_*
  68                       vmode   see FB_VMODE_*
  69                       depth   Color depth in bits per pixel
  70                       All other parameters in the variable bootargs are ignored.
  71                       It is also possible to set the parameters direct in the
  72                       variable "videomode", or in another variable i.e.
  73                       "myvideo" and setting the variable "videomode=myvideo"..
  74 ****************************************************************************/
  75
  76 #include <common.h>
  77 #include <linux/ctype.h>
  78
  79 #include "videomodes.h"
  80
  81 const struct ctfb_vesa_modes vesa_modes[VESA_MODES_COUNT] = {
  82         {0x301, RES_MODE_640x480, 8},
  83         {0x310, RES_MODE_640x480, 15},
  84         {0x311, RES_MODE_640x480, 16},
  85         {0x312, RES_MODE_640x480, 24},
  86         {0x303, RES_MODE_800x600, 8},
  87         {0x313, RES_MODE_800x600, 15},
  88         {0x314, RES_MODE_800x600, 16},
  89         {0x315, RES_MODE_800x600, 24},
  90         {0x305, RES_MODE_1024x768, 8},
  91         {0x316, RES_MODE_1024x768, 15},
  92         {0x317, RES_MODE_1024x768, 16},
  93         {0x318, RES_MODE_1024x768, 24},
  94         {0x161, RES_MODE_1152x864, 8},
  95         {0x162, RES_MODE_1152x864, 15},
  96         {0x163, RES_MODE_1152x864, 16},
  97         {0x307, RES_MODE_1280x1024, 8},
  98         {0x319, RES_MODE_1280x1024, 15},
  99         {0x31A, RES_MODE_1280x1024, 16},
 100         {0x31B, RES_MODE_1280x1024, 24},
 101 };
 102 const struct ctfb_res_modes res_mode_init[RES_MODES_COUNT] = {
 103         /* x     y pixclk   le  ri  up  lo   hs vs  s  vmode */
 104         {640, 480, 39721, 40, 24, 32, 11, 96, 2, 0, FB_VMODE_NONINTERLACED},
 105         {800, 600, 27778, 64, 24, 22, 1, 72, 2, 0, FB_VMODE_NONINTERLACED},
 106         {1024, 768, 15384, 168, 8, 29, 3, 144, 4, 0, FB_VMODE_NONINTERLACED},
 107         {960, 720, 13100, 160, 40, 32, 8, 80, 4, 0, FB_VMODE_NONINTERLACED},
 108         {1152, 864, 12004, 200, 64, 32, 16, 80, 4, 0, FB_VMODE_NONINTERLACED},
 109         {1280, 1024, 9090, 200, 48, 26, 1, 184, 3, 0, FB_VMODE_NONINTERLACED},
 110 };
 111
 112 /************************************************************************
 113  * Get Parameters for the video mode:
 114  */
 115 /*********************************************************************
 116  * returns the length to the next seperator
 117  */
 118 static int
 119 video_get_param_len (char *start, char sep)
 120 {
 121         int i = 0;
 122         while ((*start != 0) && (*start != sep)) {
 123                 start++;
 124                 i++;
 125         }
 126         return i;
 127 }
 128
 129 static int
 130 video_search_param (char *start, char *param)
 131 {
 132         int len, totallen, i;
 133         char *p = start;
 134         len = strlen (param);
 135         totallen = len + strlen (start);
 136         for (i = 0; i < totallen; i++) {
 137                 if (strncmp (p++, param, len) == 0)
 138                         return (i);
 139         }
 140         return -1;
 141 }
 142
 143 /***************************************************************
 144  * Get parameter via the environment as it is done for the
 145  * linux kernel i.e:
 146  * video=ctfb:x:800,xv:1280,y:600,yv:1024,depth:16,mode:0,pclk:25000,
 147  *       le:56,ri:48,up:26,lo:5,hs:152,vs:2,sync:0,vmode:0,accel:0
 148  *
 149  * penv is a pointer to the environment, containing the string, or the name of
 150  * another environment variable. It could even be the term "bootargs"
 151  */
 152
 153 #define GET_OPTION(name,var)                            \
 154         if(strncmp(p,name,strlen(name))==0) {           \
 155                 val_s=p+strlen(name);                   \
 156                 var=simple_strtoul(val_s, NULL, 10);    \
 157         }
 158
 159 int video_get_params (struct ctfb_res_modes *pPar, char *penv)
 160 {
 161         char *p, *s, *val_s;
 162         int i = 0, t;
 163         int bpp;
 164         int mode;
 165         /* first search for the environment containing the real param string */
 166         s = penv;
 167         if ((p = getenv (s)) != NULL) {
 168                 s = p;
 169         }
 170         /* in case of the bootargs line, we have to start
 171          * after "video=ctfb:"
 172          */
 173         i = video_search_param (s, "video=ctfb:");
 174         if (i >= 0) {
 175                 s += i;
 176                 s += strlen ("video=ctfb:");
 177         }
 178         /* search for mode as a default value */
 179         p = s;
 180         t = 0;
 181         mode = 0;               /* default */
 182         while ((i = video_get_param_len (p, ',')) != 0) {
 183                 GET_OPTION ("mode:", mode)
 184                         p += i;
 185                 if (*p != 0)
 186                         p++;    /* skip ',' */
 187         }
 188         if (mode >= RES_MODES_COUNT)
 189                 mode = 0;
 190         *pPar = res_mode_init[mode];    /* copy default values */
 191         bpp = 24 - ((mode % 3) * 8);
 192         p = s;                  /* restart */
 193         while ((i = video_get_param_len (p, ',')) != 0) {
 194                 GET_OPTION ("x:", pPar->xres)
 195                         GET_OPTION ("y:", pPar->yres)
 196                         GET_OPTION ("le:", pPar->left_margin)
 197                         GET_OPTION ("ri:", pPar->right_margin)
 198                         GET_OPTION ("up:", pPar->upper_margin)
 199                         GET_OPTION ("lo:", pPar->lower_margin)
 200                         GET_OPTION ("hs:", pPar->hsync_len)
 201                         GET_OPTION ("vs:", pPar->vsync_len)
 202                         GET_OPTION ("sync:", pPar->sync)
 203                         GET_OPTION ("vmode:", pPar->vmode)
 204                         GET_OPTION ("pclk:", pPar->pixclock)
 205                         GET_OPTION ("depth:", bpp)
 206                         p += i;
 207                 if (*p != 0)
 208                         p++;    /* skip ',' */
 209         }
 210         return bpp;
 211 }
 212
 213 /*
 214  * Parse the 'video-mode' environment variable
 215  *
 216  * Example: "video-mode=fslfb:1280x1024-32@60,monitor=dvi".  See
 217  * doc/README.video for more information on how to set the variable.
 218  *
 219  * @xres: returned value of X-resolution
 220  * @yres: returned value of Y-resolution
 221  * @depth: returned value of color depth
 222  * @freq: returned value of monitor frequency
 223  * @options: pointer to any remaining options, or NULL
 224  *
 225  * Returns 1 if valid values were found, 0 otherwise
 226  */
 227 int video_get_video_mode(unsigned int *xres, unsigned int *yres,
 228         unsigned int *depth, unsigned int *freq, const char **options)
 229 {
 230         char *p = getenv("video-mode");
 231         if (!p)
 232                 return 0;
 233
 234         /* Skip over the driver name, which we don't care about. */
 235         p = strchr(p, ':');
 236         if (!p)
 237                 return 0;
 238
 239         /* Get the X-resolution*/
 240         while (*p && !isdigit(*p))
 241                 p++;
 242         *xres = simple_strtoul(p, &p, 10);
 243         if (!*xres)
 244                 return 0;
 245
 246         /* Get the Y-resolution */
 247         while (*p && !isdigit(*p))
 248                 p++;
 249         *yres = simple_strtoul(p, &p, 10);
 250         if (!*yres)
 251                 return 0;
 252
 253         /* Get the depth */
 254         while (*p && !isdigit(*p))
 255                 p++;
 256         *depth = simple_strtoul(p, &p, 10);
 257         if (!*depth)
 258                 return 0;
 259
 260         /* Get the frequency */
 261         while (*p && !isdigit(*p))
 262                 p++;
 263         *freq = simple_strtoul(p, &p, 10);
 264         if (!*freq)
 265                 return 0;
 266
 267         /* Find the extra options, if any */
 268         p = strchr(p, ',');
 269         *options = p ? p + 1 : NULL;
 270
 271         return 1;
 272 }