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;
 163         int bpp;
 164         int mode;
 165
 166         /* first search for the environment containing the real param string */
 167         s = penv;
 168
 169         if ((p = getenv (s)) != NULL)
 170                 s = p;
 171
 172         /*
 173          * in case of the bootargs line, we have to start
 174          * after "video=ctfb:"
 175          */
 176         i = video_search_param (s, "video=ctfb:");
 177         if (i >= 0) {
 178                 s += i;
 179                 s += strlen ("video=ctfb:");
 180         }
 181         /* search for mode as a default value */
 182         p = s;
 183         mode = 0;               /* default */
 184
 185         while ((i = video_get_param_len (p, ',')) != 0) {
 186                 GET_OPTION ("mode:", mode)
 187                         p += i;
 188                 if (*p != 0)
 189                         p++;    /* skip ',' */
 190         }
 191
 192         if (mode >= RES_MODES_COUNT)
 193                 mode = 0;
 194
 195         *pPar = res_mode_init[mode];    /* copy default values */
 196         bpp = 24 - ((mode % 3) * 8);
 197         p = s;                  /* restart */
 198
 199         while ((i = video_get_param_len (p, ',')) != 0) {
 200                 GET_OPTION ("x:", pPar->xres)
 201                         GET_OPTION ("y:", pPar->yres)
 202                         GET_OPTION ("le:", pPar->left_margin)
 203                         GET_OPTION ("ri:", pPar->right_margin)
 204                         GET_OPTION ("up:", pPar->upper_margin)
 205                         GET_OPTION ("lo:", pPar->lower_margin)
 206                         GET_OPTION ("hs:", pPar->hsync_len)
 207                         GET_OPTION ("vs:", pPar->vsync_len)
 208                         GET_OPTION ("sync:", pPar->sync)
 209                         GET_OPTION ("vmode:", pPar->vmode)
 210                         GET_OPTION ("pclk:", pPar->pixclock)
 211                         GET_OPTION ("depth:", bpp)
 212                         p += i;
 213                 if (*p != 0)
 214                         p++;    /* skip ',' */
 215         }
 216         return bpp;
 217 }
 218
 219 /*
 220  * Parse the 'video-mode' environment variable
 221  *
 222  * Example: "video-mode=fslfb:1280x1024-32@60,monitor=dvi".  See
 223  * doc/README.video for more information on how to set the variable.
 224  *
 225  * @xres: returned value of X-resolution
 226  * @yres: returned value of Y-resolution
 227  * @depth: returned value of color depth
 228  * @freq: returned value of monitor frequency
 229  * @options: pointer to any remaining options, or NULL
 230  *
 231  * Returns 1 if valid values were found, 0 otherwise
 232  */
 233 int video_get_video_mode(unsigned int *xres, unsigned int *yres,
 234         unsigned int *depth, unsigned int *freq, const char **options)
 235 {
 236         char *p = getenv("video-mode");
 237         if (!p)
 238                 return 0;
 239
 240         /* Skip over the driver name, which we don't care about. */
 241         p = strchr(p, ':');
 242         if (!p)
 243                 return 0;
 244
 245         /* Get the X-resolution*/
 246         while (*p && !isdigit(*p))
 247                 p++;
 248         *xres = simple_strtoul(p, &p, 10);
 249         if (!*xres)
 250                 return 0;
 251
 252         /* Get the Y-resolution */
 253         while (*p && !isdigit(*p))
 254                 p++;
 255         *yres = simple_strtoul(p, &p, 10);
 256         if (!*yres)
 257                 return 0;
 258
 259         /* Get the depth */
 260         while (*p && !isdigit(*p))
 261                 p++;
 262         *depth = simple_strtoul(p, &p, 10);
 263         if (!*depth)
 264                 return 0;
 265
 266         /* Get the frequency */
 267         while (*p && !isdigit(*p))
 268                 p++;
 269         *freq = simple_strtoul(p, &p, 10);
 270         if (!*freq)
 271                 return 0;
 272
 273         /* Find the extra options, if any */
 274         p = strchr(p, ',');
 275         *options = p ? p + 1 : NULL;
 276
 277         return 1;
 278 }