138 static void c_set_disp_reg(const struct carmine_fb *par,  in c_set_disp_reg()  argument
141 	writel(val, par->display_reg + offset);  in c_set_disp_reg()
144 static u32 c_get_disp_reg(const struct carmine_fb *par,  in c_get_disp_reg()  argument
147 	return readl(par->display_reg + offset);  in c_get_disp_reg()
219 static void carmine_init_display_param(struct carmine_fb *par)  in carmine_init_display_param()  argument
225 	u32 soffset = par->smem_offset;  in carmine_init_display_param()
227 	c_set_disp_reg(par, CARMINE_DISP_REG_C_TRANS, 0);  in carmine_init_display_param()
228 	c_set_disp_reg(par, CARMINE_DISP_REG_MLMR_TRANS, 0);  in carmine_init_display_param()
229 	c_set_disp_reg(par, CARMINE_DISP_REG_CURSOR_MODE,  in carmine_init_display_param()
235 	c_set_disp_reg(par, CARMINE_DISP_REG_CUR1_POS, 0 << 16 | 0);  in carmine_init_display_param()
236 	c_set_disp_reg(par, CARMINE_DISP_REG_CUR2_POS, 0 << 16 | 0);  in carmine_init_display_param()
239 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_EXT_MODE, CARMINE_WINDOW_MODE |  in carmine_init_display_param()
241 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_EXT_MODE,  in carmine_init_display_param()
243 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
245 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
247 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
249 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
251 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
253 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_EXT_MODE, CARMINE_EXTEND_MODE |  in carmine_init_display_param()
257 	width = par->res->hdp * 4 / CARMINE_DISP_WIDTH_UNIT;  in carmine_init_display_param()
260 	height = par->res->vdp - 1;  in carmine_init_display_param()
263 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_MODE_W_H, param);  in carmine_init_display_param()
264 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIDTH, width);  in carmine_init_display_param()
265 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_MODE_W_H, param);  in carmine_init_display_param()
266 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_MODE_W_H, param);  in carmine_init_display_param()
267 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_MODE_W_H, param);  in carmine_init_display_param()
268 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_MODE_W_H, param);  in carmine_init_display_param()
269 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_MODE_W_H, param);  in carmine_init_display_param()
270 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_MODE_W_H, param);  in carmine_init_display_param()
273 	window_size = (par->res->vdp - 1) << CARMINE_DISP_WIN_H_SHIFT;  in carmine_init_display_param()
274 	window_size |= par->res->hdp;  in carmine_init_display_param()
276 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_WIN_POS, 0);  in carmine_init_display_param()
277 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_WIN_SIZE, window_size);  in carmine_init_display_param()
278 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIN_POS, 0);  in carmine_init_display_param()
279 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIN_SIZE, window_size);  in carmine_init_display_param()
280 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_WIN_POS, 0);  in carmine_init_display_param()
281 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_WIN_SIZE, window_size);  in carmine_init_display_param()
282 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_WIN_POS, 0);  in carmine_init_display_param()
283 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_WIN_SIZE, window_size);  in carmine_init_display_param()
284 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_WIN_POS, 0);  in carmine_init_display_param()
285 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_WIN_SIZE, window_size);  in carmine_init_display_param()
286 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_WIN_POS, 0);  in carmine_init_display_param()
287 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_WIN_SIZE, window_size);  in carmine_init_display_param()
288 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_WIN_POS, 0);  in carmine_init_display_param()
289 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_WIN_SIZE, window_size);  in carmine_init_display_param()
290 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_WIN_POS, 0);  in carmine_init_display_param()
291 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_WIN_SIZE, window_size);  in carmine_init_display_param()
294 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_ORG_ADR, soffset);  in carmine_init_display_param()
295 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_ORG_ADR, soffset);  in carmine_init_display_param()
296 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_ORG_ADR1, soffset);  in carmine_init_display_param()
297 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_ORG_ADR1, soffset);  in carmine_init_display_param()
298 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_ORG_ADR1, soffset);  in carmine_init_display_param()
299 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_ORG_ADR1, soffset);  in carmine_init_display_param()
300 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_ORG_ADR1, soffset);  in carmine_init_display_param()
301 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_ORG_ADR1, soffset);  in carmine_init_display_param()
304 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_DISP_ADR, soffset);  in carmine_init_display_param()
305 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_DISP_ADR1, soffset);  in carmine_init_display_param()
306 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_DISP_ADR1, soffset);  in carmine_init_display_param()
307 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_DISP_ADR1, soffset);  in carmine_init_display_param()
308 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_DISP_ADR1, soffset);  in carmine_init_display_param()
309 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_DISP_ADR0, soffset);  in carmine_init_display_param()
310 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_DISP_ADR0, soffset);  in carmine_init_display_param()
313 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_DISP_POS, 0);  in carmine_init_display_param()
314 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_DISP_POS, 0);  in carmine_init_display_param()
315 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_DISP_POS, 0);  in carmine_init_display_param()
316 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_DISP_POS, 0);  in carmine_init_display_param()
317 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_DISP_POS, 0);  in carmine_init_display_param()
318 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_DISP_POS, 0);  in carmine_init_display_param()
319 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_DISP_POS, 0);  in carmine_init_display_param()
322 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L0, 0);  in carmine_init_display_param()
323 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L1, 0);  in carmine_init_display_param()
324 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L2, 0);  in carmine_init_display_param()
325 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L3, 0);  in carmine_init_display_param()
326 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L4, 0);  in carmine_init_display_param()
327 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L5, 0);  in carmine_init_display_param()
328 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L6, 0);  in carmine_init_display_param()
329 	c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L7, 0);  in carmine_init_display_param()
332 	c_set_disp_reg(par, CARMINE_DISP_REG_L0_TRANS, 0);  in carmine_init_display_param()
333 	c_set_disp_reg(par, CARMINE_DISP_REG_L1_TRANS, 0);  in carmine_init_display_param()
334 	c_set_disp_reg(par, CARMINE_DISP_REG_L2_TRANS, 0);  in carmine_init_display_param()
335 	c_set_disp_reg(par, CARMINE_DISP_REG_L3_TRANS, 0);  in carmine_init_display_param()
336 	c_set_disp_reg(par, CARMINE_DISP_REG_L4_TRANS, 0);  in carmine_init_display_param()
337 	c_set_disp_reg(par, CARMINE_DISP_REG_L5_TRANS, 0);  in carmine_init_display_param()
338 	c_set_disp_reg(par, CARMINE_DISP_REG_L6_TRANS, 0);  in carmine_init_display_param()
339 	c_set_disp_reg(par, CARMINE_DISP_REG_L7_TRANS, 0);  in carmine_init_display_param()
342 	c_set_disp_reg(par, CARMINE_DISP_REG_L0RM, 0);  in carmine_init_display_param()
343 	c_set_disp_reg(par, CARMINE_DISP_REG_L2RM, 0);  in carmine_init_display_param()
344 	c_set_disp_reg(par, CARMINE_DISP_REG_L3RM, 0);  in carmine_init_display_param()
345 	c_set_disp_reg(par, CARMINE_DISP_REG_L4RM, 0);  in carmine_init_display_param()
346 	c_set_disp_reg(par, CARMINE_DISP_REG_L5RM, 0);  in carmine_init_display_param()
347 	c_set_disp_reg(par, CARMINE_DISP_REG_L6RM, 0);  in carmine_init_display_param()
348 	c_set_disp_reg(par, CARMINE_DISP_REG_L7RM, 0);  in carmine_init_display_param()
350 	c_set_disp_reg(par, CARMINE_DISP_REG_L0PX, 0);  in carmine_init_display_param()
351 	c_set_disp_reg(par, CARMINE_DISP_REG_L2PX, 0);  in carmine_init_display_param()
352 	c_set_disp_reg(par, CARMINE_DISP_REG_L3PX, 0);  in carmine_init_display_param()
353 	c_set_disp_reg(par, CARMINE_DISP_REG_L4PX, 0);  in carmine_init_display_param()
354 	c_set_disp_reg(par, CARMINE_DISP_REG_L5PX, 0);  in carmine_init_display_param()
355 	c_set_disp_reg(par, CARMINE_DISP_REG_L6PX, 0);  in carmine_init_display_param()
356 	c_set_disp_reg(par, CARMINE_DISP_REG_L7PX, 0);  in carmine_init_display_param()
358 	c_set_disp_reg(par, CARMINE_DISP_REG_L0PY, 0);  in carmine_init_display_param()
359 	c_set_disp_reg(par, CARMINE_DISP_REG_L2PY, 0);  in carmine_init_display_param()
360 	c_set_disp_reg(par, CARMINE_DISP_REG_L3PY, 0);  in carmine_init_display_param()
361 	c_set_disp_reg(par, CARMINE_DISP_REG_L4PY, 0);  in carmine_init_display_param()
362 	c_set_disp_reg(par, CARMINE_DISP_REG_L5PY, 0);  in carmine_init_display_param()
363 	c_set_disp_reg(par, CARMINE_DISP_REG_L6PY, 0);  in carmine_init_display_param()
364 	c_set_disp_reg(par, CARMINE_DISP_REG_L7PY, 0);  in carmine_init_display_param()
367 static void set_display_parameters(struct carmine_fb *par)  in set_display_parameters()  argument
376 	hdp = par->res->hdp - 1;  in set_display_parameters()
377 	vdp = par->res->vdp - 1;  in set_display_parameters()
378 	htp = par->res->htp - 1;  in set_display_parameters()
379 	hsp = par->res->hsp - 1;  in set_display_parameters()
380 	hsw = par->res->hsw - 1;  in set_display_parameters()
381 	vtr = par->res->vtr - 1;  in set_display_parameters()
382 	vsp = par->res->vsp - 1;  in set_display_parameters()
383 	vsw = par->res->vsw - 1;  in set_display_parameters()
385 	c_set_disp_reg(par, CARMINE_DISP_REG_H_TOTAL,  in set_display_parameters()
387 	c_set_disp_reg(par, CARMINE_DISP_REG_H_PERIOD,  in set_display_parameters()
389 	c_set_disp_reg(par, CARMINE_DISP_REG_V_H_W_H_POS,  in set_display_parameters()
393 	c_set_disp_reg(par, CARMINE_DISP_REG_V_TOTAL,  in set_display_parameters()
395 	c_set_disp_reg(par, CARMINE_DISP_REG_V_PERIOD_POS,  in set_display_parameters()
399 	mode = c_get_disp_reg(par, CARMINE_DISP_REG_DCM1);  in set_display_parameters()
401 		(par->res->disp_mode & CARMINE_DISP_DCM_MASK);  in set_display_parameters()
404 	c_set_disp_reg(par, CARMINE_DISP_REG_DCM1, mode);  in set_display_parameters()
409 	struct carmine_fb *par = info->par;  in carmine_set_par()  local
416 	par->new_mode = ret;  in carmine_set_par()
417 	if (par->cur_mode != par->new_mode) {  in carmine_set_par()
419 		par->cur_mode = par->new_mode;  in carmine_set_par()
420 		par->res = &car_modes[par->new_mode];  in carmine_set_par()
422 		carmine_init_display_param(par);  in carmine_set_par()
423 		set_display_parameters(par);  in carmine_set_par()
546 	struct carmine_fb *par;  in alloc_carmine_fb()  local
548 	info = framebuffer_alloc(sizeof *par, device);  in alloc_carmine_fb()
552 	par = info->par;  in alloc_carmine_fb()
553 	par->display_reg = regs;  in alloc_carmine_fb()
554 	par->smem_offset = smem_offset;  in alloc_carmine_fb()
561 	info->pseudo_palette = par->pseudo_palette;  in alloc_carmine_fb()
571 	par->cur_mode = par->new_mode = ~0;  in alloc_carmine_fb()