139 static void c_set_disp_reg(const struct carmine_fb *par,  in c_set_disp_reg()  argument
142 	writel(val, par->display_reg + offset);  in c_set_disp_reg()
145 static u32 c_get_disp_reg(const struct carmine_fb *par,  in c_get_disp_reg()  argument
148 	return readl(par->display_reg + offset);  in c_get_disp_reg()
220 static void carmine_init_display_param(struct carmine_fb *par)  in carmine_init_display_param()  argument
226 	u32 soffset = par->smem_offset;  in carmine_init_display_param()
228 	c_set_disp_reg(par, CARMINE_DISP_REG_C_TRANS, 0);  in carmine_init_display_param()
229 	c_set_disp_reg(par, CARMINE_DISP_REG_MLMR_TRANS, 0);  in carmine_init_display_param()
230 	c_set_disp_reg(par, CARMINE_DISP_REG_CURSOR_MODE,  in carmine_init_display_param()
236 	c_set_disp_reg(par, CARMINE_DISP_REG_CUR1_POS, 0 << 16 | 0);  in carmine_init_display_param()
237 	c_set_disp_reg(par, CARMINE_DISP_REG_CUR2_POS, 0 << 16 | 0);  in carmine_init_display_param()
240 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_EXT_MODE, CARMINE_WINDOW_MODE |  in carmine_init_display_param()
242 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_EXT_MODE,  in carmine_init_display_param()
244 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
246 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
248 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
250 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
252 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
254 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
258 	width = par->res->hdp * 4 / CARMINE_DISP_WIDTH_UNIT;  in carmine_init_display_param()
261 	height = par->res->vdp - 1;  in carmine_init_display_param()
264 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_MODE_W_H, param);  in carmine_init_display_param()
265 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIDTH, width);  in carmine_init_display_param()
266 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_MODE_W_H, param);  in carmine_init_display_param()
267 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_MODE_W_H, param);  in carmine_init_display_param()
268 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_MODE_W_H, param);  in carmine_init_display_param()
269 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_MODE_W_H, param);  in carmine_init_display_param()
270 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_MODE_W_H, param);  in carmine_init_display_param()
271 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_MODE_W_H, param);  in carmine_init_display_param()
274 	window_size = (par->res->vdp - 1) << CARMINE_DISP_WIN_H_SHIFT;  in carmine_init_display_param()
275 	window_size |= par->res->hdp;  in carmine_init_display_param()
277 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_WIN_POS, 0);  in carmine_init_display_param()
278 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_WIN_SIZE, window_size);  in carmine_init_display_param()
279 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIN_POS, 0);  in carmine_init_display_param()
280 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIN_SIZE, window_size);  in carmine_init_display_param()
281 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_WIN_POS, 0);  in carmine_init_display_param()
282 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_WIN_SIZE, window_size);  in carmine_init_display_param()
283 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_WIN_POS, 0);  in carmine_init_display_param()
284 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_WIN_SIZE, window_size);  in carmine_init_display_param()
285 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_WIN_POS, 0);  in carmine_init_display_param()
286 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_WIN_SIZE, window_size);  in carmine_init_display_param()
287 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_WIN_POS, 0);  in carmine_init_display_param()
288 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_WIN_SIZE, window_size);  in carmine_init_display_param()
289 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_WIN_POS, 0);  in carmine_init_display_param()
290 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_WIN_SIZE, window_size);  in carmine_init_display_param()
291 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_WIN_POS, 0);  in carmine_init_display_param()
292 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_WIN_SIZE, window_size);  in carmine_init_display_param()
295 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_ORG_ADR, soffset);  in carmine_init_display_param()
296 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_ORG_ADR, soffset);  in carmine_init_display_param()
297 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_ORG_ADR1, soffset);  in carmine_init_display_param()
298 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_ORG_ADR1, soffset);  in carmine_init_display_param()
299 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_ORG_ADR1, soffset);  in carmine_init_display_param()
300 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_ORG_ADR1, soffset);  in carmine_init_display_param()
301 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_ORG_ADR1, soffset);  in carmine_init_display_param()
302 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_ORG_ADR1, soffset);  in carmine_init_display_param()
305 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_DISP_ADR, soffset);  in carmine_init_display_param()
306 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_DISP_ADR1, soffset);  in carmine_init_display_param()
307 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_DISP_ADR1, soffset);  in carmine_init_display_param()
308 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_DISP_ADR1, soffset);  in carmine_init_display_param()
309 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_DISP_ADR1, soffset);  in carmine_init_display_param()
310 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_DISP_ADR0, soffset);  in carmine_init_display_param()
311 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_DISP_ADR0, soffset);  in carmine_init_display_param()
314 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_DISP_POS, 0);  in carmine_init_display_param()
315 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_DISP_POS, 0);  in carmine_init_display_param()
316 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_DISP_POS, 0);  in carmine_init_display_param()
317 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_DISP_POS, 0);  in carmine_init_display_param()
318 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_DISP_POS, 0);  in carmine_init_display_param()
319 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_DISP_POS, 0);  in carmine_init_display_param()
320 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_DISP_POS, 0);  in carmine_init_display_param()
323 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L0, 0);  in carmine_init_display_param()
324 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L1, 0);  in carmine_init_display_param()
325 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L2, 0);  in carmine_init_display_param()
326 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L3, 0);  in carmine_init_display_param()
327 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L4, 0);  in carmine_init_display_param()
328 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L5, 0);  in carmine_init_display_param()
329 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L6, 0);  in carmine_init_display_param()
330 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L7, 0);  in carmine_init_display_param()
333 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_TRANS, 0);  in carmine_init_display_param()
334 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_TRANS, 0);  in carmine_init_display_param()
335 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_TRANS, 0);  in carmine_init_display_param()
336 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_TRANS, 0);  in carmine_init_display_param()
337 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_TRANS, 0);  in carmine_init_display_param()
338 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_TRANS, 0);  in carmine_init_display_param()
339 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_TRANS, 0);  in carmine_init_display_param()
340 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_TRANS, 0);  in carmine_init_display_param()
343 	c_set_disp_reg(par, CARMINE_DISP_REG_L0RM, 0);  in carmine_init_display_param()
344 	c_set_disp_reg(par, CARMINE_DISP_REG_L2RM, 0);  in carmine_init_display_param()
345 	c_set_disp_reg(par, CARMINE_DISP_REG_L3RM, 0);  in carmine_init_display_param()
346 	c_set_disp_reg(par, CARMINE_DISP_REG_L4RM, 0);  in carmine_init_display_param()
347 	c_set_disp_reg(par, CARMINE_DISP_REG_L5RM, 0);  in carmine_init_display_param()
348 	c_set_disp_reg(par, CARMINE_DISP_REG_L6RM, 0);  in carmine_init_display_param()
349 	c_set_disp_reg(par, CARMINE_DISP_REG_L7RM, 0);  in carmine_init_display_param()
351 	c_set_disp_reg(par, CARMINE_DISP_REG_L0PX, 0);  in carmine_init_display_param()
352 	c_set_disp_reg(par, CARMINE_DISP_REG_L2PX, 0);  in carmine_init_display_param()
353 	c_set_disp_reg(par, CARMINE_DISP_REG_L3PX, 0);  in carmine_init_display_param()
354 	c_set_disp_reg(par, CARMINE_DISP_REG_L4PX, 0);  in carmine_init_display_param()
355 	c_set_disp_reg(par, CARMINE_DISP_REG_L5PX, 0);  in carmine_init_display_param()
356 	c_set_disp_reg(par, CARMINE_DISP_REG_L6PX, 0);  in carmine_init_display_param()
357 	c_set_disp_reg(par, CARMINE_DISP_REG_L7PX, 0);  in carmine_init_display_param()
359 	c_set_disp_reg(par, CARMINE_DISP_REG_L0PY, 0);  in carmine_init_display_param()
360 	c_set_disp_reg(par, CARMINE_DISP_REG_L2PY, 0);  in carmine_init_display_param()
361 	c_set_disp_reg(par, CARMINE_DISP_REG_L3PY, 0);  in carmine_init_display_param()
362 	c_set_disp_reg(par, CARMINE_DISP_REG_L4PY, 0);  in carmine_init_display_param()
363 	c_set_disp_reg(par, CARMINE_DISP_REG_L5PY, 0);  in carmine_init_display_param()
364 	c_set_disp_reg(par, CARMINE_DISP_REG_L6PY, 0);  in carmine_init_display_param()
365 	c_set_disp_reg(par, CARMINE_DISP_REG_L7PY, 0);  in carmine_init_display_param()
368 static void set_display_parameters(struct carmine_fb *par)  in set_display_parameters()  argument
377 	hdp = par->res->hdp - 1;  in set_display_parameters()
378 	vdp = par->res->vdp - 1;  in set_display_parameters()
379 	htp = par->res->htp - 1;  in set_display_parameters()
380 	hsp = par->res->hsp - 1;  in set_display_parameters()
381 	hsw = par->res->hsw - 1;  in set_display_parameters()
382 	vtr = par->res->vtr - 1;  in set_display_parameters()
383 	vsp = par->res->vsp - 1;  in set_display_parameters()
384 	vsw = par->res->vsw - 1;  in set_display_parameters()
386 	c_set_disp_reg(par, CARMINE_DISP_REG_H_TOTAL,  in set_display_parameters()
388 	c_set_disp_reg(par, CARMINE_DISP_REG_H_PERIOD,  in set_display_parameters()
390 	c_set_disp_reg(par, CARMINE_DISP_REG_V_H_W_H_POS,  in set_display_parameters()
394 	c_set_disp_reg(par, CARMINE_DISP_REG_V_TOTAL,  in set_display_parameters()
396 	c_set_disp_reg(par, CARMINE_DISP_REG_V_PERIOD_POS,  in set_display_parameters()
400 	mode = c_get_disp_reg(par, CARMINE_DISP_REG_DCM1);  in set_display_parameters()
402 		(par->res->disp_mode & CARMINE_DISP_DCM_MASK);  in set_display_parameters()
405 	c_set_disp_reg(par, CARMINE_DISP_REG_DCM1, mode);  in set_display_parameters()
410 	struct carmine_fb *par = info->par;  in carmine_set_par()  local
417 	par->new_mode = ret;  in carmine_set_par()
418 	if (par->cur_mode != par->new_mode) {  in carmine_set_par()
420 		par->cur_mode = par->new_mode;  in carmine_set_par()
421 		par->res = &car_modes[par->new_mode];  in carmine_set_par()
423 		carmine_init_display_param(par);  in carmine_set_par()
424 		set_display_parameters(par);  in carmine_set_par()
547 	struct carmine_fb *par;  in alloc_carmine_fb()  local
549 	info = framebuffer_alloc(sizeof *par, device);  in alloc_carmine_fb()
553 	par = info->par;  in alloc_carmine_fb()
554 	par->display_reg = regs;  in alloc_carmine_fb()
555 	par->smem_offset = smem_offset;  in alloc_carmine_fb()
562 	info->pseudo_palette = par->pseudo_palette;  in alloc_carmine_fb()
572 	par->cur_mode = par->new_mode = ~0;  in alloc_carmine_fb()