1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2352d2591SJean-Christophe PLAGNIOL-VILLARD /*
3352d2591SJean-Christophe PLAGNIOL-VILLARD * (C) Copyright 2004
4352d2591SJean-Christophe PLAGNIOL-VILLARD * Pierre Aubert, Staubli Faverges , <p.aubert@staubli.com>
5a5dbdc81STimur Tabi * Copyright 2011 Freescale Semiconductor, Inc.
6352d2591SJean-Christophe PLAGNIOL-VILLARD */
7352d2591SJean-Christophe PLAGNIOL-VILLARD
8352d2591SJean-Christophe PLAGNIOL-VILLARD /************************************************************************
9352d2591SJean-Christophe PLAGNIOL-VILLARD Get Parameters for the video mode:
106d0f6bcfSJean-Christophe PLAGNIOL-VILLARD The default video mode can be defined in CONFIG_SYS_DEFAULT_VIDEO_MODE.
11352d2591SJean-Christophe PLAGNIOL-VILLARD If undefined, default video mode is set to 0x301
12352d2591SJean-Christophe PLAGNIOL-VILLARD Parameters can be set via the variable "videomode" in the environment.
13352d2591SJean-Christophe PLAGNIOL-VILLARD 2 diferent ways are possible:
14352d2591SJean-Christophe PLAGNIOL-VILLARD "videomode=301" - 301 is a hexadecimal number describing the VESA
15352d2591SJean-Christophe PLAGNIOL-VILLARD mode. Following modes are implemented:
16352d2591SJean-Christophe PLAGNIOL-VILLARD
17352d2591SJean-Christophe PLAGNIOL-VILLARD Colors 640x480 800x600 1024x768 1152x864 1280x1024
18352d2591SJean-Christophe PLAGNIOL-VILLARD --------+---------------------------------------------
19352d2591SJean-Christophe PLAGNIOL-VILLARD 8 bits | 0x301 0x303 0x305 0x161 0x307
20352d2591SJean-Christophe PLAGNIOL-VILLARD 15 bits | 0x310 0x313 0x316 0x162 0x319
21352d2591SJean-Christophe PLAGNIOL-VILLARD 16 bits | 0x311 0x314 0x317 0x163 0x31A
22352d2591SJean-Christophe PLAGNIOL-VILLARD 24 bits | 0x312 0x315 0x318 ? 0x31B
23352d2591SJean-Christophe PLAGNIOL-VILLARD --------+---------------------------------------------
24352d2591SJean-Christophe PLAGNIOL-VILLARD "videomode=bootargs"
25352d2591SJean-Christophe PLAGNIOL-VILLARD - the parameters are parsed from the bootargs.
26352d2591SJean-Christophe PLAGNIOL-VILLARD The format is "NAME:VALUE,NAME:VALUE" etc.
27352d2591SJean-Christophe PLAGNIOL-VILLARD Ex.:
28352d2591SJean-Christophe PLAGNIOL-VILLARD "bootargs=video=ctfb:x:800,y:600,depth:16,pclk:25000"
29352d2591SJean-Christophe PLAGNIOL-VILLARD Parameters not included in the list will be taken from
30352d2591SJean-Christophe PLAGNIOL-VILLARD the default mode, which is one of the following:
31352d2591SJean-Christophe PLAGNIOL-VILLARD mode:0 640x480x24
32352d2591SJean-Christophe PLAGNIOL-VILLARD mode:1 800x600x16
33352d2591SJean-Christophe PLAGNIOL-VILLARD mode:2 1024x768x8
34352d2591SJean-Christophe PLAGNIOL-VILLARD mode:3 960x720x24
35352d2591SJean-Christophe PLAGNIOL-VILLARD mode:4 1152x864x16
36352d2591SJean-Christophe PLAGNIOL-VILLARD mode:5 1280x1024x8
37352d2591SJean-Christophe PLAGNIOL-VILLARD
38352d2591SJean-Christophe PLAGNIOL-VILLARD if "mode" is not provided within the parameter list,
39352d2591SJean-Christophe PLAGNIOL-VILLARD mode:0 is assumed.
40352d2591SJean-Christophe PLAGNIOL-VILLARD Following parameters are supported:
41352d2591SJean-Christophe PLAGNIOL-VILLARD x xres = visible resolution horizontal
42352d2591SJean-Christophe PLAGNIOL-VILLARD y yres = visible resolution vertical
43352d2591SJean-Christophe PLAGNIOL-VILLARD pclk pixelclocks in pico sec
44352d2591SJean-Christophe PLAGNIOL-VILLARD le left_marging time from sync to picture in pixelclocks
45352d2591SJean-Christophe PLAGNIOL-VILLARD ri right_marging time from picture to sync in pixelclocks
46352d2591SJean-Christophe PLAGNIOL-VILLARD up upper_margin time from sync to picture
47352d2591SJean-Christophe PLAGNIOL-VILLARD lo lower_margin
48352d2591SJean-Christophe PLAGNIOL-VILLARD hs hsync_len length of horizontal sync
49352d2591SJean-Christophe PLAGNIOL-VILLARD vs vsync_len length of vertical sync
50352d2591SJean-Christophe PLAGNIOL-VILLARD sync see FB_SYNC_*
51352d2591SJean-Christophe PLAGNIOL-VILLARD vmode see FB_VMODE_*
52352d2591SJean-Christophe PLAGNIOL-VILLARD depth Color depth in bits per pixel
53352d2591SJean-Christophe PLAGNIOL-VILLARD All other parameters in the variable bootargs are ignored.
54352d2591SJean-Christophe PLAGNIOL-VILLARD It is also possible to set the parameters direct in the
55352d2591SJean-Christophe PLAGNIOL-VILLARD variable "videomode", or in another variable i.e.
56352d2591SJean-Christophe PLAGNIOL-VILLARD "myvideo" and setting the variable "videomode=myvideo"..
57352d2591SJean-Christophe PLAGNIOL-VILLARD ****************************************************************************/
58352d2591SJean-Christophe PLAGNIOL-VILLARD
59352d2591SJean-Christophe PLAGNIOL-VILLARD #include <common.h>
60b7ce12ddSHans de Goede #include <edid.h>
61b7ce12ddSHans de Goede #include <errno.h>
62a5dbdc81STimur Tabi #include <linux/ctype.h>
63a5dbdc81STimur Tabi
64352d2591SJean-Christophe PLAGNIOL-VILLARD #include "videomodes.h"
65352d2591SJean-Christophe PLAGNIOL-VILLARD
66352d2591SJean-Christophe PLAGNIOL-VILLARD const struct ctfb_vesa_modes vesa_modes[VESA_MODES_COUNT] = {
67352d2591SJean-Christophe PLAGNIOL-VILLARD {0x301, RES_MODE_640x480, 8},
68352d2591SJean-Christophe PLAGNIOL-VILLARD {0x310, RES_MODE_640x480, 15},
69352d2591SJean-Christophe PLAGNIOL-VILLARD {0x311, RES_MODE_640x480, 16},
70352d2591SJean-Christophe PLAGNIOL-VILLARD {0x312, RES_MODE_640x480, 24},
71352d2591SJean-Christophe PLAGNIOL-VILLARD {0x303, RES_MODE_800x600, 8},
72352d2591SJean-Christophe PLAGNIOL-VILLARD {0x313, RES_MODE_800x600, 15},
73352d2591SJean-Christophe PLAGNIOL-VILLARD {0x314, RES_MODE_800x600, 16},
74352d2591SJean-Christophe PLAGNIOL-VILLARD {0x315, RES_MODE_800x600, 24},
75352d2591SJean-Christophe PLAGNIOL-VILLARD {0x305, RES_MODE_1024x768, 8},
76352d2591SJean-Christophe PLAGNIOL-VILLARD {0x316, RES_MODE_1024x768, 15},
77352d2591SJean-Christophe PLAGNIOL-VILLARD {0x317, RES_MODE_1024x768, 16},
78352d2591SJean-Christophe PLAGNIOL-VILLARD {0x318, RES_MODE_1024x768, 24},
79352d2591SJean-Christophe PLAGNIOL-VILLARD {0x161, RES_MODE_1152x864, 8},
80352d2591SJean-Christophe PLAGNIOL-VILLARD {0x162, RES_MODE_1152x864, 15},
81352d2591SJean-Christophe PLAGNIOL-VILLARD {0x163, RES_MODE_1152x864, 16},
82352d2591SJean-Christophe PLAGNIOL-VILLARD {0x307, RES_MODE_1280x1024, 8},
83352d2591SJean-Christophe PLAGNIOL-VILLARD {0x319, RES_MODE_1280x1024, 15},
84352d2591SJean-Christophe PLAGNIOL-VILLARD {0x31A, RES_MODE_1280x1024, 16},
85352d2591SJean-Christophe PLAGNIOL-VILLARD {0x31B, RES_MODE_1280x1024, 24},
86352d2591SJean-Christophe PLAGNIOL-VILLARD };
87352d2591SJean-Christophe PLAGNIOL-VILLARD const struct ctfb_res_modes res_mode_init[RES_MODES_COUNT] = {
880c91d257SHans de Goede /* x y hz pixclk ps/kHz le ri up lo hs vs s vmode */
8992a88c33SHans de Goede #ifndef CONFIG_VIDEO_STD_TIMINGS
900c91d257SHans de Goede { 640, 480, 60, 39721, 25180, 40, 24, 32, 11, 96, 2, 0, FB_VMODE_NONINTERLACED},
910c91d257SHans de Goede { 800, 600, 60, 27778, 36000, 64, 24, 22, 1, 72, 2, 0, FB_VMODE_NONINTERLACED},
920c91d257SHans de Goede {1024, 768, 60, 15384, 65000, 168, 8, 29, 3, 144, 4, 0, FB_VMODE_NONINTERLACED},
930c91d257SHans de Goede { 960, 720, 80, 13100, 76335, 160, 40, 32, 8, 80, 4, 0, FB_VMODE_NONINTERLACED},
940c91d257SHans de Goede {1152, 864, 60, 12004, 83300, 200, 64, 32, 16, 80, 4, 0, FB_VMODE_NONINTERLACED},
950c91d257SHans de Goede {1280, 1024, 60, 9090, 110000, 200, 48, 26, 1, 184, 3, 0, FB_VMODE_NONINTERLACED},
9692a88c33SHans de Goede #else
9792a88c33SHans de Goede { 640, 480, 60, 39683, 25200, 48, 16, 33, 10, 96, 2, 0, FB_VMODE_NONINTERLACED},
9892a88c33SHans de Goede { 800, 600, 60, 25000, 40000, 88, 40, 23, 1, 128, 4, FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED},
9992a88c33SHans de Goede {1024, 768, 60, 15384, 65000, 160, 24, 29, 3, 136, 6, 0, FB_VMODE_NONINTERLACED},
10092a88c33SHans de Goede { 960, 720, 75, 13468, 74250, 176, 72, 27, 1, 112, 2, 0, FB_VMODE_NONINTERLACED},
10192a88c33SHans de Goede {1152, 864, 75, 9259, 108000, 256, 64, 32, 1, 128, 3, FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED},
10292a88c33SHans de Goede {1280, 1024, 60, 9259, 108000, 248, 48, 38, 1, 112, 3, FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED},
10392a88c33SHans de Goede #endif
10459bb6109SHans de Goede {1280, 720, 60, 13468, 74250, 220, 110, 20, 5, 40, 5, FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED},
10559bb6109SHans de Goede {1360, 768, 60, 11696, 85500, 256, 64, 17, 3, 112, 7, 0, FB_VMODE_NONINTERLACED},
10659bb6109SHans de Goede {1920, 1080, 60, 6734, 148500, 148, 88, 36, 4, 44, 5, FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED},
10759bb6109SHans de Goede {1920, 1200, 60, 6494, 154000, 80, 48, 26, 3, 32, 6, FB_SYNC_HOR_HIGH_ACT, FB_VMODE_NONINTERLACED},
108352d2591SJean-Christophe PLAGNIOL-VILLARD };
109352d2591SJean-Christophe PLAGNIOL-VILLARD
110352d2591SJean-Christophe PLAGNIOL-VILLARD /************************************************************************
111352d2591SJean-Christophe PLAGNIOL-VILLARD * Get Parameters for the video mode:
112352d2591SJean-Christophe PLAGNIOL-VILLARD */
113352d2591SJean-Christophe PLAGNIOL-VILLARD /*********************************************************************
114352d2591SJean-Christophe PLAGNIOL-VILLARD * returns the length to the next seperator
115352d2591SJean-Christophe PLAGNIOL-VILLARD */
116352d2591SJean-Christophe PLAGNIOL-VILLARD static int
video_get_param_len(const char * start,char sep)117eb3c0cf8SHans de Goede video_get_param_len(const char *start, char sep)
118352d2591SJean-Christophe PLAGNIOL-VILLARD {
119352d2591SJean-Christophe PLAGNIOL-VILLARD int i = 0;
120352d2591SJean-Christophe PLAGNIOL-VILLARD while ((*start != 0) && (*start != sep)) {
121352d2591SJean-Christophe PLAGNIOL-VILLARD start++;
122352d2591SJean-Christophe PLAGNIOL-VILLARD i++;
123352d2591SJean-Christophe PLAGNIOL-VILLARD }
124352d2591SJean-Christophe PLAGNIOL-VILLARD return i;
125352d2591SJean-Christophe PLAGNIOL-VILLARD }
126352d2591SJean-Christophe PLAGNIOL-VILLARD
127352d2591SJean-Christophe PLAGNIOL-VILLARD static int
video_search_param(char * start,char * param)128352d2591SJean-Christophe PLAGNIOL-VILLARD video_search_param (char *start, char *param)
129352d2591SJean-Christophe PLAGNIOL-VILLARD {
130352d2591SJean-Christophe PLAGNIOL-VILLARD int len, totallen, i;
131352d2591SJean-Christophe PLAGNIOL-VILLARD char *p = start;
132352d2591SJean-Christophe PLAGNIOL-VILLARD len = strlen (param);
133352d2591SJean-Christophe PLAGNIOL-VILLARD totallen = len + strlen (start);
134352d2591SJean-Christophe PLAGNIOL-VILLARD for (i = 0; i < totallen; i++) {
135352d2591SJean-Christophe PLAGNIOL-VILLARD if (strncmp (p++, param, len) == 0)
136352d2591SJean-Christophe PLAGNIOL-VILLARD return (i);
137352d2591SJean-Christophe PLAGNIOL-VILLARD }
138352d2591SJean-Christophe PLAGNIOL-VILLARD return -1;
139352d2591SJean-Christophe PLAGNIOL-VILLARD }
140352d2591SJean-Christophe PLAGNIOL-VILLARD
141352d2591SJean-Christophe PLAGNIOL-VILLARD /***************************************************************
142352d2591SJean-Christophe PLAGNIOL-VILLARD * Get parameter via the environment as it is done for the
143352d2591SJean-Christophe PLAGNIOL-VILLARD * linux kernel i.e:
144352d2591SJean-Christophe PLAGNIOL-VILLARD * video=ctfb:x:800,xv:1280,y:600,yv:1024,depth:16,mode:0,pclk:25000,
145352d2591SJean-Christophe PLAGNIOL-VILLARD * le:56,ri:48,up:26,lo:5,hs:152,vs:2,sync:0,vmode:0,accel:0
146352d2591SJean-Christophe PLAGNIOL-VILLARD *
147352d2591SJean-Christophe PLAGNIOL-VILLARD * penv is a pointer to the environment, containing the string, or the name of
148352d2591SJean-Christophe PLAGNIOL-VILLARD * another environment variable. It could even be the term "bootargs"
149352d2591SJean-Christophe PLAGNIOL-VILLARD */
150352d2591SJean-Christophe PLAGNIOL-VILLARD
151352d2591SJean-Christophe PLAGNIOL-VILLARD #define GET_OPTION(name,var) \
152352d2591SJean-Christophe PLAGNIOL-VILLARD if(strncmp(p,name,strlen(name))==0) { \
153352d2591SJean-Christophe PLAGNIOL-VILLARD val_s=p+strlen(name); \
154352d2591SJean-Christophe PLAGNIOL-VILLARD var=simple_strtoul(val_s, NULL, 10); \
155352d2591SJean-Christophe PLAGNIOL-VILLARD }
156352d2591SJean-Christophe PLAGNIOL-VILLARD
video_get_params(struct ctfb_res_modes * pPar,char * penv)157352d2591SJean-Christophe PLAGNIOL-VILLARD int video_get_params (struct ctfb_res_modes *pPar, char *penv)
158352d2591SJean-Christophe PLAGNIOL-VILLARD {
159352d2591SJean-Christophe PLAGNIOL-VILLARD char *p, *s, *val_s;
16040ac78a9SWolfgang Denk int i = 0;
161352d2591SJean-Christophe PLAGNIOL-VILLARD int bpp;
162352d2591SJean-Christophe PLAGNIOL-VILLARD int mode;
16340ac78a9SWolfgang Denk
164352d2591SJean-Christophe PLAGNIOL-VILLARD /* first search for the environment containing the real param string */
165352d2591SJean-Christophe PLAGNIOL-VILLARD s = penv;
16640ac78a9SWolfgang Denk
16700caae6dSSimon Glass p = env_get(s);
16800caae6dSSimon Glass if (p)
169352d2591SJean-Christophe PLAGNIOL-VILLARD s = p;
17040ac78a9SWolfgang Denk
17140ac78a9SWolfgang Denk /*
17240ac78a9SWolfgang Denk * in case of the bootargs line, we have to start
173352d2591SJean-Christophe PLAGNIOL-VILLARD * after "video=ctfb:"
174352d2591SJean-Christophe PLAGNIOL-VILLARD */
175352d2591SJean-Christophe PLAGNIOL-VILLARD i = video_search_param (s, "video=ctfb:");
176352d2591SJean-Christophe PLAGNIOL-VILLARD if (i >= 0) {
177352d2591SJean-Christophe PLAGNIOL-VILLARD s += i;
178352d2591SJean-Christophe PLAGNIOL-VILLARD s += strlen ("video=ctfb:");
179352d2591SJean-Christophe PLAGNIOL-VILLARD }
180352d2591SJean-Christophe PLAGNIOL-VILLARD /* search for mode as a default value */
181352d2591SJean-Christophe PLAGNIOL-VILLARD p = s;
182352d2591SJean-Christophe PLAGNIOL-VILLARD mode = 0; /* default */
18340ac78a9SWolfgang Denk
184352d2591SJean-Christophe PLAGNIOL-VILLARD while ((i = video_get_param_len (p, ',')) != 0) {
185352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("mode:", mode)
186352d2591SJean-Christophe PLAGNIOL-VILLARD p += i;
187352d2591SJean-Christophe PLAGNIOL-VILLARD if (*p != 0)
188352d2591SJean-Christophe PLAGNIOL-VILLARD p++; /* skip ',' */
189352d2591SJean-Christophe PLAGNIOL-VILLARD }
19040ac78a9SWolfgang Denk
191352d2591SJean-Christophe PLAGNIOL-VILLARD if (mode >= RES_MODES_COUNT)
192352d2591SJean-Christophe PLAGNIOL-VILLARD mode = 0;
19340ac78a9SWolfgang Denk
194352d2591SJean-Christophe PLAGNIOL-VILLARD *pPar = res_mode_init[mode]; /* copy default values */
195352d2591SJean-Christophe PLAGNIOL-VILLARD bpp = 24 - ((mode % 3) * 8);
196352d2591SJean-Christophe PLAGNIOL-VILLARD p = s; /* restart */
19740ac78a9SWolfgang Denk
198352d2591SJean-Christophe PLAGNIOL-VILLARD while ((i = video_get_param_len (p, ',')) != 0) {
199352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("x:", pPar->xres)
200352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("y:", pPar->yres)
2010c91d257SHans de Goede GET_OPTION ("refresh:", pPar->refresh)
202352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("le:", pPar->left_margin)
203352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("ri:", pPar->right_margin)
204352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("up:", pPar->upper_margin)
205352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("lo:", pPar->lower_margin)
206352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("hs:", pPar->hsync_len)
207352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("vs:", pPar->vsync_len)
208352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("sync:", pPar->sync)
209352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("vmode:", pPar->vmode)
210352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("pclk:", pPar->pixclock)
2110c91d257SHans de Goede GET_OPTION ("pclk_khz:", pPar->pixclock_khz)
212352d2591SJean-Christophe PLAGNIOL-VILLARD GET_OPTION ("depth:", bpp)
213352d2591SJean-Christophe PLAGNIOL-VILLARD p += i;
214352d2591SJean-Christophe PLAGNIOL-VILLARD if (*p != 0)
215352d2591SJean-Christophe PLAGNIOL-VILLARD p++; /* skip ',' */
216352d2591SJean-Christophe PLAGNIOL-VILLARD }
217352d2591SJean-Christophe PLAGNIOL-VILLARD return bpp;
218352d2591SJean-Christophe PLAGNIOL-VILLARD }
219a5dbdc81STimur Tabi
220a5dbdc81STimur Tabi /*
221a5dbdc81STimur Tabi * Parse the 'video-mode' environment variable
222a5dbdc81STimur Tabi *
223a5dbdc81STimur Tabi * Example: "video-mode=fslfb:1280x1024-32@60,monitor=dvi". See
224a5dbdc81STimur Tabi * doc/README.video for more information on how to set the variable.
225a5dbdc81STimur Tabi *
226a5dbdc81STimur Tabi * @xres: returned value of X-resolution
227a5dbdc81STimur Tabi * @yres: returned value of Y-resolution
228a5dbdc81STimur Tabi * @depth: returned value of color depth
229a5dbdc81STimur Tabi * @freq: returned value of monitor frequency
230a5dbdc81STimur Tabi * @options: pointer to any remaining options, or NULL
231a5dbdc81STimur Tabi *
232a5dbdc81STimur Tabi * Returns 1 if valid values were found, 0 otherwise
233a5dbdc81STimur Tabi */
video_get_video_mode(unsigned int * xres,unsigned int * yres,unsigned int * depth,unsigned int * freq,const char ** options)234a5dbdc81STimur Tabi int video_get_video_mode(unsigned int *xres, unsigned int *yres,
235a5dbdc81STimur Tabi unsigned int *depth, unsigned int *freq, const char **options)
236a5dbdc81STimur Tabi {
23700caae6dSSimon Glass char *p = env_get("video-mode");
238a5dbdc81STimur Tabi if (!p)
239a5dbdc81STimur Tabi return 0;
240a5dbdc81STimur Tabi
241a5dbdc81STimur Tabi /* Skip over the driver name, which we don't care about. */
242a5dbdc81STimur Tabi p = strchr(p, ':');
243a5dbdc81STimur Tabi if (!p)
244a5dbdc81STimur Tabi return 0;
245a5dbdc81STimur Tabi
246a5dbdc81STimur Tabi /* Get the X-resolution*/
247a5dbdc81STimur Tabi while (*p && !isdigit(*p))
248a5dbdc81STimur Tabi p++;
249a5dbdc81STimur Tabi *xres = simple_strtoul(p, &p, 10);
250a5dbdc81STimur Tabi if (!*xres)
251a5dbdc81STimur Tabi return 0;
252a5dbdc81STimur Tabi
253a5dbdc81STimur Tabi /* Get the Y-resolution */
254a5dbdc81STimur Tabi while (*p && !isdigit(*p))
255a5dbdc81STimur Tabi p++;
256a5dbdc81STimur Tabi *yres = simple_strtoul(p, &p, 10);
257a5dbdc81STimur Tabi if (!*yres)
258a5dbdc81STimur Tabi return 0;
259a5dbdc81STimur Tabi
260a5dbdc81STimur Tabi /* Get the depth */
261a5dbdc81STimur Tabi while (*p && !isdigit(*p))
262a5dbdc81STimur Tabi p++;
263a5dbdc81STimur Tabi *depth = simple_strtoul(p, &p, 10);
264a5dbdc81STimur Tabi if (!*depth)
265a5dbdc81STimur Tabi return 0;
266a5dbdc81STimur Tabi
267a5dbdc81STimur Tabi /* Get the frequency */
268a5dbdc81STimur Tabi while (*p && !isdigit(*p))
269a5dbdc81STimur Tabi p++;
270a5dbdc81STimur Tabi *freq = simple_strtoul(p, &p, 10);
271a5dbdc81STimur Tabi if (!*freq)
272a5dbdc81STimur Tabi return 0;
273a5dbdc81STimur Tabi
274a5dbdc81STimur Tabi /* Find the extra options, if any */
275a5dbdc81STimur Tabi p = strchr(p, ',');
276a5dbdc81STimur Tabi *options = p ? p + 1 : NULL;
277a5dbdc81STimur Tabi
278a5dbdc81STimur Tabi return 1;
279a5dbdc81STimur Tabi }
280e976b868SHans de Goede
281e976b868SHans de Goede /*
282e976b868SHans de Goede * Parse the 'video-mode' environment variable using video_get_video_mode()
283e976b868SHans de Goede * and lookup the matching ctfb_res_modes in res_mode_init.
284e976b868SHans de Goede *
285e976b868SHans de Goede * @default_mode: RES_MODE_##x## define for the mode to store in mode_ret
286e976b868SHans de Goede * when 'video-mode' is not set or does not contain a valid mode
287e976b868SHans de Goede * @default_depth: depth to set when 'video-mode' is not set
288e976b868SHans de Goede * @mode_ret: pointer where the mode will be stored
289e976b868SHans de Goede * @depth_ret: pointer where the depth will be stored
290e976b868SHans de Goede * @options: pointer to any remaining options, or NULL
291e976b868SHans de Goede */
video_get_ctfb_res_modes(int default_mode,unsigned int default_depth,const struct ctfb_res_modes ** mode_ret,unsigned int * depth_ret,const char ** options)292e976b868SHans de Goede void video_get_ctfb_res_modes(int default_mode, unsigned int default_depth,
293e976b868SHans de Goede const struct ctfb_res_modes **mode_ret,
294e976b868SHans de Goede unsigned int *depth_ret,
295e976b868SHans de Goede const char **options)
296e976b868SHans de Goede {
297e976b868SHans de Goede unsigned int i, xres, yres, depth, refresh;
298e976b868SHans de Goede
299e976b868SHans de Goede *mode_ret = &res_mode_init[default_mode];
300e976b868SHans de Goede *depth_ret = default_depth;
301e976b868SHans de Goede *options = NULL;
302e976b868SHans de Goede
303e976b868SHans de Goede if (!video_get_video_mode(&xres, &yres, &depth, &refresh, options))
304e976b868SHans de Goede return;
305e976b868SHans de Goede
306e976b868SHans de Goede for (i = 0; i < RES_MODES_COUNT; i++) {
307e976b868SHans de Goede if (res_mode_init[i].xres == xres &&
308e976b868SHans de Goede res_mode_init[i].yres == yres &&
309e976b868SHans de Goede res_mode_init[i].refresh == refresh) {
310e976b868SHans de Goede *mode_ret = &res_mode_init[i];
311e976b868SHans de Goede *depth_ret = depth;
312e976b868SHans de Goede return;
313e976b868SHans de Goede }
314e976b868SHans de Goede }
315e976b868SHans de Goede
316e976b868SHans de Goede printf("video-mode %dx%d-%d@%d not available, falling back to %dx%d-%d@%d\n",
317e976b868SHans de Goede xres, yres, depth, refresh, (*mode_ret)->xres,
318e976b868SHans de Goede (*mode_ret)->yres, *depth_ret, (*mode_ret)->refresh);
319e976b868SHans de Goede }
320eb3c0cf8SHans de Goede
321eb3c0cf8SHans de Goede /*
322eb3c0cf8SHans de Goede * Find the named string option within the ',' separated options string, and
323eb3c0cf8SHans de Goede * store its value in dest.
324eb3c0cf8SHans de Goede *
325eb3c0cf8SHans de Goede * @options: ',' separated options string
326eb3c0cf8SHans de Goede * @name: name of the option to look for
327eb3c0cf8SHans de Goede * @dest: destination buffer to store the value of the option in
328eb3c0cf8SHans de Goede * @dest_len: length of dest
329eb3c0cf8SHans de Goede * @def: value to store in dest if the option is not present in options
330eb3c0cf8SHans de Goede */
video_get_option_string(const char * options,const char * name,char * dest,int dest_len,const char * def)331eb3c0cf8SHans de Goede void video_get_option_string(const char *options, const char *name,
332eb3c0cf8SHans de Goede char *dest, int dest_len, const char *def)
333eb3c0cf8SHans de Goede {
334eb3c0cf8SHans de Goede const char *p = options;
335eb3c0cf8SHans de Goede const int name_len = strlen(name);
336eb3c0cf8SHans de Goede int i, len;
337eb3c0cf8SHans de Goede
338eb3c0cf8SHans de Goede while (p && (i = video_get_param_len(p, ',')) != 0) {
339eb3c0cf8SHans de Goede if (strncmp(p, name, name_len) == 0 && p[name_len] == '=') {
340eb3c0cf8SHans de Goede len = i - (name_len + 1);
341eb3c0cf8SHans de Goede if (len >= dest_len)
342eb3c0cf8SHans de Goede len = dest_len - 1;
343eb3c0cf8SHans de Goede memcpy(dest, &p[name_len + 1], len);
344eb3c0cf8SHans de Goede dest[len] = 0;
345eb3c0cf8SHans de Goede return;
346eb3c0cf8SHans de Goede }
347eb3c0cf8SHans de Goede p += i;
348eb3c0cf8SHans de Goede if (*p != 0)
349eb3c0cf8SHans de Goede p++; /* skip ',' */
350eb3c0cf8SHans de Goede }
351eb3c0cf8SHans de Goede strcpy(dest, def);
352eb3c0cf8SHans de Goede }
353eb3c0cf8SHans de Goede
354eb3c0cf8SHans de Goede /*
355eb3c0cf8SHans de Goede * Find the named integer option within the ',' separated options string, and
356eb3c0cf8SHans de Goede * return its value.
357eb3c0cf8SHans de Goede *
358eb3c0cf8SHans de Goede * @options: ',' separated options string
359eb3c0cf8SHans de Goede * @name: name of the option to look for
360eb3c0cf8SHans de Goede * @def: value to return if the option is not present in options
361eb3c0cf8SHans de Goede */
video_get_option_int(const char * options,const char * name,int def)362eb3c0cf8SHans de Goede int video_get_option_int(const char *options, const char *name, int def)
363eb3c0cf8SHans de Goede {
364eb3c0cf8SHans de Goede const char *p = options;
365eb3c0cf8SHans de Goede const int name_len = strlen(name);
366eb3c0cf8SHans de Goede int i;
367eb3c0cf8SHans de Goede
368eb3c0cf8SHans de Goede while (p && (i = video_get_param_len(p, ',')) != 0) {
369eb3c0cf8SHans de Goede if (strncmp(p, name, name_len) == 0 && p[name_len] == '=')
370eb3c0cf8SHans de Goede return simple_strtoul(&p[name_len + 1], NULL, 10);
371eb3c0cf8SHans de Goede
372eb3c0cf8SHans de Goede p += i;
373eb3c0cf8SHans de Goede if (*p != 0)
374eb3c0cf8SHans de Goede p++; /* skip ',' */
375eb3c0cf8SHans de Goede }
376eb3c0cf8SHans de Goede return def;
377eb3c0cf8SHans de Goede }
378b7ce12ddSHans de Goede
379b7ce12ddSHans de Goede /**
380b7ce12ddSHans de Goede * Convert an EDID detailed timing to a struct ctfb_res_modes
381b7ce12ddSHans de Goede *
382b7ce12ddSHans de Goede * @param t The EDID detailed timing to be converted
383b7ce12ddSHans de Goede * @param mode Returns the converted timing
384b7ce12ddSHans de Goede *
385b7ce12ddSHans de Goede * @return 0 on success, or a negative errno on error
386b7ce12ddSHans de Goede */
video_edid_dtd_to_ctfb_res_modes(struct edid_detailed_timing * t,struct ctfb_res_modes * mode)387b7ce12ddSHans de Goede int video_edid_dtd_to_ctfb_res_modes(struct edid_detailed_timing *t,
388b7ce12ddSHans de Goede struct ctfb_res_modes *mode)
389b7ce12ddSHans de Goede {
390b7ce12ddSHans de Goede int margin, h_total, v_total;
391b7ce12ddSHans de Goede
392b7ce12ddSHans de Goede /* Check all timings are non 0 */
393b7ce12ddSHans de Goede if (EDID_DETAILED_TIMING_PIXEL_CLOCK(*t) == 0 ||
394b7ce12ddSHans de Goede EDID_DETAILED_TIMING_HORIZONTAL_ACTIVE(*t) == 0 ||
395b7ce12ddSHans de Goede EDID_DETAILED_TIMING_HORIZONTAL_BLANKING(*t) == 0 ||
396b7ce12ddSHans de Goede EDID_DETAILED_TIMING_VERTICAL_ACTIVE(*t) == 0 ||
397b7ce12ddSHans de Goede EDID_DETAILED_TIMING_VERTICAL_BLANKING(*t) == 0 ||
398b7ce12ddSHans de Goede EDID_DETAILED_TIMING_HSYNC_OFFSET(*t) == 0 ||
399b7ce12ddSHans de Goede EDID_DETAILED_TIMING_VSYNC_OFFSET(*t) == 0 ||
400b7ce12ddSHans de Goede /* 3d formats are not supported*/
401b7ce12ddSHans de Goede EDID_DETAILED_TIMING_FLAG_STEREO(*t) != 0)
402b7ce12ddSHans de Goede return -EINVAL;
403b7ce12ddSHans de Goede
404b7ce12ddSHans de Goede mode->xres = EDID_DETAILED_TIMING_HORIZONTAL_ACTIVE(*t);
405b7ce12ddSHans de Goede mode->yres = EDID_DETAILED_TIMING_VERTICAL_ACTIVE(*t);
406b7ce12ddSHans de Goede
407b7ce12ddSHans de Goede h_total = mode->xres + EDID_DETAILED_TIMING_HORIZONTAL_BLANKING(*t);
408b7ce12ddSHans de Goede v_total = mode->yres + EDID_DETAILED_TIMING_VERTICAL_BLANKING(*t);
409b7ce12ddSHans de Goede mode->refresh = EDID_DETAILED_TIMING_PIXEL_CLOCK(*t) /
410b7ce12ddSHans de Goede (h_total * v_total);
411b7ce12ddSHans de Goede
412b7ce12ddSHans de Goede mode->pixclock_khz = EDID_DETAILED_TIMING_PIXEL_CLOCK(*t) / 1000;
413b7ce12ddSHans de Goede mode->pixclock = 1000000000L / mode->pixclock_khz;
414b7ce12ddSHans de Goede
415b7ce12ddSHans de Goede mode->right_margin = EDID_DETAILED_TIMING_HSYNC_OFFSET(*t);
416b7ce12ddSHans de Goede mode->hsync_len = EDID_DETAILED_TIMING_HSYNC_PULSE_WIDTH(*t);
417b7ce12ddSHans de Goede margin = EDID_DETAILED_TIMING_HORIZONTAL_BLANKING(*t) -
418b7ce12ddSHans de Goede (mode->right_margin + mode->hsync_len);
419b7ce12ddSHans de Goede if (margin <= 0)
420b7ce12ddSHans de Goede return -EINVAL;
421b7ce12ddSHans de Goede
422b7ce12ddSHans de Goede mode->left_margin = margin;
423b7ce12ddSHans de Goede
424b7ce12ddSHans de Goede mode->lower_margin = EDID_DETAILED_TIMING_VSYNC_OFFSET(*t);
425b7ce12ddSHans de Goede mode->vsync_len = EDID_DETAILED_TIMING_VSYNC_PULSE_WIDTH(*t);
426b7ce12ddSHans de Goede margin = EDID_DETAILED_TIMING_VERTICAL_BLANKING(*t) -
427b7ce12ddSHans de Goede (mode->lower_margin + mode->vsync_len);
428b7ce12ddSHans de Goede if (margin <= 0)
429b7ce12ddSHans de Goede return -EINVAL;
430b7ce12ddSHans de Goede
431b7ce12ddSHans de Goede mode->upper_margin = margin;
432b7ce12ddSHans de Goede
433b7ce12ddSHans de Goede mode->sync = 0;
434b7ce12ddSHans de Goede if (EDID_DETAILED_TIMING_FLAG_HSYNC_POLARITY(*t))
435b7ce12ddSHans de Goede mode->sync |= FB_SYNC_HOR_HIGH_ACT;
436b7ce12ddSHans de Goede if (EDID_DETAILED_TIMING_FLAG_VSYNC_POLARITY(*t))
437b7ce12ddSHans de Goede mode->sync |= FB_SYNC_VERT_HIGH_ACT;
438b7ce12ddSHans de Goede
439b7ce12ddSHans de Goede if (EDID_DETAILED_TIMING_FLAG_INTERLACED(*t))
440b7ce12ddSHans de Goede mode->vmode = FB_VMODE_INTERLACED;
441b7ce12ddSHans de Goede else
442b7ce12ddSHans de Goede mode->vmode = FB_VMODE_NONINTERLACED;
443b7ce12ddSHans de Goede
444b7ce12ddSHans de Goede return 0;
445b7ce12ddSHans de Goede }
446