1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Frame buffer driver for the Carmine GPU. 4 * 5 * The driver configures the GPU as follows 6 * - FB0 is display 0 with unique memory area 7 * - FB1 is display 1 with unique memory area 8 * - both display use 32 bit colors 9 */ 10 #include <linux/aperture.h> 11 #include <linux/delay.h> 12 #include <linux/errno.h> 13 #include <linux/fb.h> 14 #include <linux/interrupt.h> 15 #include <linux/pci.h> 16 #include <linux/slab.h> 17 #include <linux/module.h> 18 19 #include "carminefb.h" 20 #include "carminefb_regs.h" 21 22 #if !defined(__LITTLE_ENDIAN) && !defined(__BIG_ENDIAN) 23 #error "The endianness of the target host has not been defined." 24 #endif 25 26 /* 27 * The initial video mode can be supplied via two different ways: 28 * - as a string that is passed to fb_find_mode() (module option fb_mode_str) 29 * - as an integer that picks the video mode from carmine_modedb[] (module 30 * option fb_mode) 31 * 32 * If nothing is used than the initial video mode will be the 33 * CARMINEFB_DEFAULT_VIDEO_MODE member of the carmine_modedb[]. 34 */ 35 #define CARMINEFB_DEFAULT_VIDEO_MODE 1 36 37 static unsigned int fb_mode = CARMINEFB_DEFAULT_VIDEO_MODE; 38 module_param(fb_mode, uint, 0444); 39 MODULE_PARM_DESC(fb_mode, "Initial video mode as integer."); 40 41 static char *fb_mode_str; 42 module_param(fb_mode_str, charp, 0444); 43 MODULE_PARM_DESC(fb_mode_str, "Initial video mode in characters."); 44 45 /* 46 * Carminefb displays: 47 * 0b000 None 48 * 0b001 Display 0 49 * 0b010 Display 1 50 */ 51 static int fb_displays = CARMINE_USE_DISPLAY0 | CARMINE_USE_DISPLAY1; 52 module_param(fb_displays, int, 0444); 53 MODULE_PARM_DESC(fb_displays, "Bit mode, which displays are used"); 54 55 struct carmine_hw { 56 void __iomem *v_regs; 57 void __iomem *screen_mem; 58 struct fb_info *fb[MAX_DISPLAY]; 59 }; 60 61 struct carmine_resolution { 62 u32 htp; 63 u32 hsp; 64 u32 hsw; 65 u32 hdp; 66 u32 vtr; 67 u32 vsp; 68 u32 vsw; 69 u32 vdp; 70 u32 disp_mode; 71 }; 72 73 struct carmine_fb { 74 void __iomem *display_reg; 75 void __iomem *screen_base; 76 u32 smem_offset; 77 u32 cur_mode; 78 u32 new_mode; 79 struct carmine_resolution *res; 80 u32 pseudo_palette[16]; 81 }; 82 83 static struct fb_fix_screeninfo carminefb_fix = { 84 .id = "Carmine", 85 .type = FB_TYPE_PACKED_PIXELS, 86 .visual = FB_VISUAL_TRUECOLOR, 87 .accel = FB_ACCEL_NONE, 88 }; 89 90 static const struct fb_videomode carmine_modedb[] = { 91 { 92 .name = "640x480", 93 .xres = 640, 94 .yres = 480, 95 }, { 96 .name = "800x600", 97 .xres = 800, 98 .yres = 600, 99 }, 100 }; 101 102 static struct carmine_resolution car_modes[] = { 103 { 104 /* 640x480 */ 105 .htp = 800, 106 .hsp = 672, 107 .hsw = 96, 108 .hdp = 640, 109 .vtr = 525, 110 .vsp = 490, 111 .vsw = 2, 112 .vdp = 480, 113 .disp_mode = 0x1400, 114 }, 115 { 116 /* 800x600 */ 117 .htp = 1060, 118 .hsp = 864, 119 .hsw = 72, 120 .hdp = 800, 121 .vtr = 628, 122 .vsp = 601, 123 .vsw = 2, 124 .vdp = 600, 125 .disp_mode = 0x0d00, 126 } 127 }; 128 129 static int carmine_find_mode(const struct fb_var_screeninfo *var) 130 { 131 int i; 132 133 for (i = 0; i < ARRAY_SIZE(car_modes); i++) 134 if (car_modes[i].hdp == var->xres && 135 car_modes[i].vdp == var->yres) 136 return i; 137 return -EINVAL; 138 } 139 140 static void c_set_disp_reg(const struct carmine_fb *par, 141 u32 offset, u32 val) 142 { 143 writel(val, par->display_reg + offset); 144 } 145 146 static u32 c_get_disp_reg(const struct carmine_fb *par, 147 u32 offset) 148 { 149 return readl(par->display_reg + offset); 150 } 151 152 static void c_set_hw_reg(const struct carmine_hw *hw, 153 u32 offset, u32 val) 154 { 155 writel(val, hw->v_regs + offset); 156 } 157 158 static u32 c_get_hw_reg(const struct carmine_hw *hw, 159 u32 offset) 160 { 161 return readl(hw->v_regs + offset); 162 } 163 164 static int carmine_setcolreg(unsigned regno, unsigned red, unsigned green, 165 unsigned blue, unsigned transp, struct fb_info *info) 166 { 167 if (regno >= 16) 168 return 1; 169 170 red >>= 8; 171 green >>= 8; 172 blue >>= 8; 173 transp >>= 8; 174 175 ((__be32 *)info->pseudo_palette)[regno] = cpu_to_be32(transp << 24 | 176 red << 0 | green << 8 | blue << 16); 177 return 0; 178 } 179 180 static int carmine_check_var(struct fb_var_screeninfo *var, 181 struct fb_info *info) 182 { 183 int ret; 184 185 ret = carmine_find_mode(var); 186 if (ret < 0) 187 return ret; 188 189 if (var->grayscale || var->rotate || var->nonstd) 190 return -EINVAL; 191 192 var->xres_virtual = var->xres; 193 var->yres_virtual = var->yres; 194 195 var->bits_per_pixel = 32; 196 197 #ifdef __BIG_ENDIAN 198 var->transp.offset = 24; 199 var->red.offset = 0; 200 var->green.offset = 8; 201 var->blue.offset = 16; 202 #else 203 var->transp.offset = 24; 204 var->red.offset = 16; 205 var->green.offset = 8; 206 var->blue.offset = 0; 207 #endif 208 209 var->red.length = 8; 210 var->green.length = 8; 211 var->blue.length = 8; 212 var->transp.length = 8; 213 214 var->red.msb_right = 0; 215 var->green.msb_right = 0; 216 var->blue.msb_right = 0; 217 var->transp.msb_right = 0; 218 return 0; 219 } 220 221 static void carmine_init_display_param(struct carmine_fb *par) 222 { 223 u32 width; 224 u32 height; 225 u32 param; 226 u32 window_size; 227 u32 soffset = par->smem_offset; 228 229 c_set_disp_reg(par, CARMINE_DISP_REG_C_TRANS, 0); 230 c_set_disp_reg(par, CARMINE_DISP_REG_MLMR_TRANS, 0); 231 c_set_disp_reg(par, CARMINE_DISP_REG_CURSOR_MODE, 232 CARMINE_CURSOR0_PRIORITY_MASK | 233 CARMINE_CURSOR1_PRIORITY_MASK | 234 CARMINE_CURSOR_CUTZ_MASK); 235 236 /* Set default cursor position */ 237 c_set_disp_reg(par, CARMINE_DISP_REG_CUR1_POS, 0 << 16 | 0); 238 c_set_disp_reg(par, CARMINE_DISP_REG_CUR2_POS, 0 << 16 | 0); 239 240 /* Set default display mode */ 241 c_set_disp_reg(par, CARMINE_DISP_REG_L0_EXT_MODE, CARMINE_WINDOW_MODE | 242 CARMINE_EXT_CMODE_DIRECT24_RGBA); 243 c_set_disp_reg(par, CARMINE_DISP_REG_L1_EXT_MODE, 244 CARMINE_EXT_CMODE_DIRECT24_RGBA); 245 c_set_disp_reg(par, CARMINE_DISP_REG_L2_EXT_MODE, CARMINE_EXTEND_MODE | 246 CARMINE_EXT_CMODE_DIRECT24_RGBA); 247 c_set_disp_reg(par, CARMINE_DISP_REG_L3_EXT_MODE, CARMINE_EXTEND_MODE | 248 CARMINE_EXT_CMODE_DIRECT24_RGBA); 249 c_set_disp_reg(par, CARMINE_DISP_REG_L4_EXT_MODE, CARMINE_EXTEND_MODE | 250 CARMINE_EXT_CMODE_DIRECT24_RGBA); 251 c_set_disp_reg(par, CARMINE_DISP_REG_L5_EXT_MODE, CARMINE_EXTEND_MODE | 252 CARMINE_EXT_CMODE_DIRECT24_RGBA); 253 c_set_disp_reg(par, CARMINE_DISP_REG_L6_EXT_MODE, CARMINE_EXTEND_MODE | 254 CARMINE_EXT_CMODE_DIRECT24_RGBA); 255 c_set_disp_reg(par, CARMINE_DISP_REG_L7_EXT_MODE, CARMINE_EXTEND_MODE | 256 CARMINE_EXT_CMODE_DIRECT24_RGBA); 257 258 /* Set default frame size to layer mode register */ 259 width = par->res->hdp * 4 / CARMINE_DISP_WIDTH_UNIT; 260 width = width << CARMINE_DISP_WIDTH_SHIFT; 261 262 height = par->res->vdp - 1; 263 param = width | height; 264 265 c_set_disp_reg(par, CARMINE_DISP_REG_L0_MODE_W_H, param); 266 c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIDTH, width); 267 c_set_disp_reg(par, CARMINE_DISP_REG_L2_MODE_W_H, param); 268 c_set_disp_reg(par, CARMINE_DISP_REG_L3_MODE_W_H, param); 269 c_set_disp_reg(par, CARMINE_DISP_REG_L4_MODE_W_H, param); 270 c_set_disp_reg(par, CARMINE_DISP_REG_L5_MODE_W_H, param); 271 c_set_disp_reg(par, CARMINE_DISP_REG_L6_MODE_W_H, param); 272 c_set_disp_reg(par, CARMINE_DISP_REG_L7_MODE_W_H, param); 273 274 /* Set default pos and size */ 275 window_size = (par->res->vdp - 1) << CARMINE_DISP_WIN_H_SHIFT; 276 window_size |= par->res->hdp; 277 278 c_set_disp_reg(par, CARMINE_DISP_REG_L0_WIN_POS, 0); 279 c_set_disp_reg(par, CARMINE_DISP_REG_L0_WIN_SIZE, window_size); 280 c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIN_POS, 0); 281 c_set_disp_reg(par, CARMINE_DISP_REG_L1_WIN_SIZE, window_size); 282 c_set_disp_reg(par, CARMINE_DISP_REG_L2_WIN_POS, 0); 283 c_set_disp_reg(par, CARMINE_DISP_REG_L2_WIN_SIZE, window_size); 284 c_set_disp_reg(par, CARMINE_DISP_REG_L3_WIN_POS, 0); 285 c_set_disp_reg(par, CARMINE_DISP_REG_L3_WIN_SIZE, window_size); 286 c_set_disp_reg(par, CARMINE_DISP_REG_L4_WIN_POS, 0); 287 c_set_disp_reg(par, CARMINE_DISP_REG_L4_WIN_SIZE, window_size); 288 c_set_disp_reg(par, CARMINE_DISP_REG_L5_WIN_POS, 0); 289 c_set_disp_reg(par, CARMINE_DISP_REG_L5_WIN_SIZE, window_size); 290 c_set_disp_reg(par, CARMINE_DISP_REG_L6_WIN_POS, 0); 291 c_set_disp_reg(par, CARMINE_DISP_REG_L6_WIN_SIZE, window_size); 292 c_set_disp_reg(par, CARMINE_DISP_REG_L7_WIN_POS, 0); 293 c_set_disp_reg(par, CARMINE_DISP_REG_L7_WIN_SIZE, window_size); 294 295 /* Set default origin address */ 296 c_set_disp_reg(par, CARMINE_DISP_REG_L0_ORG_ADR, soffset); 297 c_set_disp_reg(par, CARMINE_DISP_REG_L1_ORG_ADR, soffset); 298 c_set_disp_reg(par, CARMINE_DISP_REG_L2_ORG_ADR1, soffset); 299 c_set_disp_reg(par, CARMINE_DISP_REG_L3_ORG_ADR1, soffset); 300 c_set_disp_reg(par, CARMINE_DISP_REG_L4_ORG_ADR1, soffset); 301 c_set_disp_reg(par, CARMINE_DISP_REG_L5_ORG_ADR1, soffset); 302 c_set_disp_reg(par, CARMINE_DISP_REG_L6_ORG_ADR1, soffset); 303 c_set_disp_reg(par, CARMINE_DISP_REG_L7_ORG_ADR1, soffset); 304 305 /* Set default display address */ 306 c_set_disp_reg(par, CARMINE_DISP_REG_L0_DISP_ADR, soffset); 307 c_set_disp_reg(par, CARMINE_DISP_REG_L2_DISP_ADR1, soffset); 308 c_set_disp_reg(par, CARMINE_DISP_REG_L3_DISP_ADR1, soffset); 309 c_set_disp_reg(par, CARMINE_DISP_REG_L4_DISP_ADR1, soffset); 310 c_set_disp_reg(par, CARMINE_DISP_REG_L5_DISP_ADR1, soffset); 311 c_set_disp_reg(par, CARMINE_DISP_REG_L6_DISP_ADR0, soffset); 312 c_set_disp_reg(par, CARMINE_DISP_REG_L7_DISP_ADR0, soffset); 313 314 /* Set default display position */ 315 c_set_disp_reg(par, CARMINE_DISP_REG_L0_DISP_POS, 0); 316 c_set_disp_reg(par, CARMINE_DISP_REG_L2_DISP_POS, 0); 317 c_set_disp_reg(par, CARMINE_DISP_REG_L3_DISP_POS, 0); 318 c_set_disp_reg(par, CARMINE_DISP_REG_L4_DISP_POS, 0); 319 c_set_disp_reg(par, CARMINE_DISP_REG_L5_DISP_POS, 0); 320 c_set_disp_reg(par, CARMINE_DISP_REG_L6_DISP_POS, 0); 321 c_set_disp_reg(par, CARMINE_DISP_REG_L7_DISP_POS, 0); 322 323 /* Set default blend mode */ 324 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L0, 0); 325 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L1, 0); 326 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L2, 0); 327 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L3, 0); 328 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L4, 0); 329 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L5, 0); 330 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L6, 0); 331 c_set_disp_reg(par, CARMINE_DISP_REG_BLEND_MODE_L7, 0); 332 333 /* default transparency mode */ 334 c_set_disp_reg(par, CARMINE_DISP_REG_L0_TRANS, 0); 335 c_set_disp_reg(par, CARMINE_DISP_REG_L1_TRANS, 0); 336 c_set_disp_reg(par, CARMINE_DISP_REG_L2_TRANS, 0); 337 c_set_disp_reg(par, CARMINE_DISP_REG_L3_TRANS, 0); 338 c_set_disp_reg(par, CARMINE_DISP_REG_L4_TRANS, 0); 339 c_set_disp_reg(par, CARMINE_DISP_REG_L5_TRANS, 0); 340 c_set_disp_reg(par, CARMINE_DISP_REG_L6_TRANS, 0); 341 c_set_disp_reg(par, CARMINE_DISP_REG_L7_TRANS, 0); 342 343 /* Set default read skip parameter */ 344 c_set_disp_reg(par, CARMINE_DISP_REG_L0RM, 0); 345 c_set_disp_reg(par, CARMINE_DISP_REG_L2RM, 0); 346 c_set_disp_reg(par, CARMINE_DISP_REG_L3RM, 0); 347 c_set_disp_reg(par, CARMINE_DISP_REG_L4RM, 0); 348 c_set_disp_reg(par, CARMINE_DISP_REG_L5RM, 0); 349 c_set_disp_reg(par, CARMINE_DISP_REG_L6RM, 0); 350 c_set_disp_reg(par, CARMINE_DISP_REG_L7RM, 0); 351 352 c_set_disp_reg(par, CARMINE_DISP_REG_L0PX, 0); 353 c_set_disp_reg(par, CARMINE_DISP_REG_L2PX, 0); 354 c_set_disp_reg(par, CARMINE_DISP_REG_L3PX, 0); 355 c_set_disp_reg(par, CARMINE_DISP_REG_L4PX, 0); 356 c_set_disp_reg(par, CARMINE_DISP_REG_L5PX, 0); 357 c_set_disp_reg(par, CARMINE_DISP_REG_L6PX, 0); 358 c_set_disp_reg(par, CARMINE_DISP_REG_L7PX, 0); 359 360 c_set_disp_reg(par, CARMINE_DISP_REG_L0PY, 0); 361 c_set_disp_reg(par, CARMINE_DISP_REG_L2PY, 0); 362 c_set_disp_reg(par, CARMINE_DISP_REG_L3PY, 0); 363 c_set_disp_reg(par, CARMINE_DISP_REG_L4PY, 0); 364 c_set_disp_reg(par, CARMINE_DISP_REG_L5PY, 0); 365 c_set_disp_reg(par, CARMINE_DISP_REG_L6PY, 0); 366 c_set_disp_reg(par, CARMINE_DISP_REG_L7PY, 0); 367 } 368 369 static void set_display_parameters(struct carmine_fb *par) 370 { 371 u32 mode; 372 u32 hdp, vdp, htp, hsp, hsw, vtr, vsp, vsw; 373 374 /* 375 * display timing. Parameters are decreased by one because hardware 376 * spec is 0 to (n - 1) 377 * */ 378 hdp = par->res->hdp - 1; 379 vdp = par->res->vdp - 1; 380 htp = par->res->htp - 1; 381 hsp = par->res->hsp - 1; 382 hsw = par->res->hsw - 1; 383 vtr = par->res->vtr - 1; 384 vsp = par->res->vsp - 1; 385 vsw = par->res->vsw - 1; 386 387 c_set_disp_reg(par, CARMINE_DISP_REG_H_TOTAL, 388 htp << CARMINE_DISP_HTP_SHIFT); 389 c_set_disp_reg(par, CARMINE_DISP_REG_H_PERIOD, 390 (hdp << CARMINE_DISP_HDB_SHIFT) | hdp); 391 c_set_disp_reg(par, CARMINE_DISP_REG_V_H_W_H_POS, 392 (vsw << CARMINE_DISP_VSW_SHIFT) | 393 (hsw << CARMINE_DISP_HSW_SHIFT) | 394 (hsp)); 395 c_set_disp_reg(par, CARMINE_DISP_REG_V_TOTAL, 396 vtr << CARMINE_DISP_VTR_SHIFT); 397 c_set_disp_reg(par, CARMINE_DISP_REG_V_PERIOD_POS, 398 (vdp << CARMINE_DISP_VDP_SHIFT) | vsp); 399 400 /* clock */ 401 mode = c_get_disp_reg(par, CARMINE_DISP_REG_DCM1); 402 mode = (mode & ~CARMINE_DISP_DCM_MASK) | 403 (par->res->disp_mode & CARMINE_DISP_DCM_MASK); 404 /* enable video output and layer 0 */ 405 mode |= CARMINE_DEN | CARMINE_L0E; 406 c_set_disp_reg(par, CARMINE_DISP_REG_DCM1, mode); 407 } 408 409 static int carmine_set_par(struct fb_info *info) 410 { 411 struct carmine_fb *par = info->par; 412 int ret; 413 414 ret = carmine_find_mode(&info->var); 415 if (ret < 0) 416 return ret; 417 418 par->new_mode = ret; 419 if (par->cur_mode != par->new_mode) { 420 421 par->cur_mode = par->new_mode; 422 par->res = &car_modes[par->new_mode]; 423 424 carmine_init_display_param(par); 425 set_display_parameters(par); 426 } 427 428 info->fix.line_length = info->var.xres * info->var.bits_per_pixel / 8; 429 return 0; 430 } 431 432 static int init_hardware(struct carmine_hw *hw) 433 { 434 u32 flags; 435 u32 loops; 436 u32 ret; 437 438 /* Initialize Carmine */ 439 /* Sets internal clock */ 440 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_CLOCK_ENABLE, 441 CARMINE_DFLT_IP_CLOCK_ENABLE); 442 443 /* Video signal output is turned off */ 444 c_set_hw_reg(hw, CARMINE_DISP0_REG + CARMINE_DISP_REG_DCM1, 0); 445 c_set_hw_reg(hw, CARMINE_DISP1_REG + CARMINE_DISP_REG_DCM1, 0); 446 447 /* Software reset */ 448 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_SOFTWARE_RESET, 1); 449 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_SOFTWARE_RESET, 0); 450 451 /* I/O mode settings */ 452 flags = CARMINE_DFLT_IP_DCTL_IO_CONT1 << 16 | 453 CARMINE_DFLT_IP_DCTL_IO_CONT0; 454 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_IOCONT1_IOCONT0, 455 flags); 456 457 /* DRAM initial sequence */ 458 flags = CARMINE_DFLT_IP_DCTL_MODE << 16 | CARMINE_DFLT_IP_DCTL_ADD; 459 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_MODE_ADD, 460 flags); 461 462 flags = CARMINE_DFLT_IP_DCTL_SET_TIME1 << 16 | 463 CARMINE_DFLT_IP_DCTL_EMODE; 464 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_SETTIME1_EMODE, 465 flags); 466 467 flags = CARMINE_DFLT_IP_DCTL_REFRESH << 16 | 468 CARMINE_DFLT_IP_DCTL_SET_TIME2; 469 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_REFRESH_SETTIME2, 470 flags); 471 472 flags = CARMINE_DFLT_IP_DCTL_RESERVE2 << 16 | 473 CARMINE_DFLT_IP_DCTL_FIFO_DEPTH; 474 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_RSV2_RSV1, flags); 475 476 flags = CARMINE_DFLT_IP_DCTL_DDRIF2 << 16 | CARMINE_DFLT_IP_DCTL_DDRIF1; 477 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_DDRIF2_DDRIF1, 478 flags); 479 480 flags = CARMINE_DFLT_IP_DCTL_RESERVE0 << 16 | 481 CARMINE_DFLT_IP_DCTL_STATES; 482 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_RSV0_STATES, 483 flags); 484 485 /* Executes DLL reset */ 486 if (CARMINE_DCTL_DLL_RESET) { 487 for (loops = 0; loops < CARMINE_DCTL_INIT_WAIT_LIMIT; loops++) { 488 489 ret = c_get_hw_reg(hw, CARMINE_DCTL_REG + 490 CARMINE_DCTL_REG_RSV0_STATES); 491 ret &= CARMINE_DCTL_REG_STATES_MASK; 492 if (!ret) 493 break; 494 495 mdelay(CARMINE_DCTL_INIT_WAIT_INTERVAL); 496 } 497 498 if (loops >= CARMINE_DCTL_INIT_WAIT_LIMIT) { 499 printk(KERN_ERR "DRAM init failed\n"); 500 return -EIO; 501 } 502 } 503 504 flags = CARMINE_DFLT_IP_DCTL_MODE_AFT_RST << 16 | 505 CARMINE_DFLT_IP_DCTL_ADD; 506 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_MODE_ADD, flags); 507 508 flags = CARMINE_DFLT_IP_DCTL_RESERVE0 << 16 | 509 CARMINE_DFLT_IP_DCTL_STATES_AFT_RST; 510 c_set_hw_reg(hw, CARMINE_DCTL_REG + CARMINE_DCTL_REG_RSV0_STATES, 511 flags); 512 513 /* Initialize the write back register */ 514 c_set_hw_reg(hw, CARMINE_WB_REG + CARMINE_WB_REG_WBM, 515 CARMINE_WB_REG_WBM_DEFAULT); 516 517 /* Initialize the Kottos registers */ 518 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_VRINTM, 0); 519 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_VRERRM, 0); 520 521 /* Set DC offsets */ 522 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_PX, 0); 523 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_PY, 0); 524 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_LX, 0); 525 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_LY, 0); 526 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_TX, 0); 527 c_set_hw_reg(hw, CARMINE_GRAPH_REG + CARMINE_GRAPH_REG_DC_OFFSET_TY, 0); 528 return 0; 529 } 530 531 static const struct fb_ops carminefb_ops = { 532 .owner = THIS_MODULE, 533 .fb_fillrect = cfb_fillrect, 534 .fb_copyarea = cfb_copyarea, 535 .fb_imageblit = cfb_imageblit, 536 537 .fb_check_var = carmine_check_var, 538 .fb_set_par = carmine_set_par, 539 .fb_setcolreg = carmine_setcolreg, 540 }; 541 542 static int alloc_carmine_fb(void __iomem *regs, void __iomem *smem_base, 543 int smem_offset, struct device *device, 544 struct fb_info **rinfo) 545 { 546 int ret; 547 struct fb_info *info; 548 struct carmine_fb *par; 549 550 info = framebuffer_alloc(sizeof *par, device); 551 if (!info) 552 return -ENOMEM; 553 554 par = info->par; 555 par->display_reg = regs; 556 par->smem_offset = smem_offset; 557 558 info->screen_base = smem_base + smem_offset; 559 info->screen_size = CARMINE_DISPLAY_MEM; 560 info->fbops = &carminefb_ops; 561 562 info->fix = carminefb_fix; 563 info->pseudo_palette = par->pseudo_palette; 564 info->flags = FBINFO_DEFAULT; 565 566 ret = fb_alloc_cmap(&info->cmap, 256, 1); 567 if (ret < 0) 568 goto err_free_fb; 569 570 if (fb_mode >= ARRAY_SIZE(carmine_modedb)) 571 fb_mode = CARMINEFB_DEFAULT_VIDEO_MODE; 572 573 par->cur_mode = par->new_mode = ~0; 574 575 ret = fb_find_mode(&info->var, info, fb_mode_str, carmine_modedb, 576 ARRAY_SIZE(carmine_modedb), 577 &carmine_modedb[fb_mode], 32); 578 if (!ret || ret == 4) { 579 ret = -EINVAL; 580 goto err_dealloc_cmap; 581 } 582 583 fb_videomode_to_modelist(carmine_modedb, ARRAY_SIZE(carmine_modedb), 584 &info->modelist); 585 586 ret = register_framebuffer(info); 587 if (ret < 0) 588 goto err_dealloc_cmap; 589 590 fb_info(info, "%s frame buffer device\n", info->fix.id); 591 592 *rinfo = info; 593 return 0; 594 595 err_dealloc_cmap: 596 fb_dealloc_cmap(&info->cmap); 597 err_free_fb: 598 framebuffer_release(info); 599 return ret; 600 } 601 602 static void cleanup_fb_device(struct fb_info *info) 603 { 604 if (info) { 605 unregister_framebuffer(info); 606 fb_dealloc_cmap(&info->cmap); 607 framebuffer_release(info); 608 } 609 } 610 611 static int carminefb_probe(struct pci_dev *dev, const struct pci_device_id *ent) 612 { 613 struct carmine_hw *hw; 614 struct device *device = &dev->dev; 615 struct fb_info *info; 616 int ret; 617 618 ret = aperture_remove_conflicting_pci_devices(dev, "carminefb"); 619 if (ret) 620 return ret; 621 622 ret = pci_enable_device(dev); 623 if (ret) 624 return ret; 625 626 ret = -ENOMEM; 627 hw = kzalloc(sizeof *hw, GFP_KERNEL); 628 if (!hw) 629 goto err_enable_pci; 630 631 carminefb_fix.mmio_start = pci_resource_start(dev, CARMINE_CONFIG_BAR); 632 carminefb_fix.mmio_len = pci_resource_len(dev, CARMINE_CONFIG_BAR); 633 634 if (!request_mem_region(carminefb_fix.mmio_start, 635 carminefb_fix.mmio_len, 636 "carminefb regbase")) { 637 printk(KERN_ERR "carminefb: Can't reserve regbase.\n"); 638 ret = -EBUSY; 639 goto err_free_hw; 640 } 641 hw->v_regs = ioremap(carminefb_fix.mmio_start, 642 carminefb_fix.mmio_len); 643 if (!hw->v_regs) { 644 printk(KERN_ERR "carminefb: Can't remap %s register.\n", 645 carminefb_fix.id); 646 goto err_free_reg_mmio; 647 } 648 649 carminefb_fix.smem_start = pci_resource_start(dev, CARMINE_MEMORY_BAR); 650 carminefb_fix.smem_len = pci_resource_len(dev, CARMINE_MEMORY_BAR); 651 652 /* The memory area tends to be very large (256 MiB). Remap only what 653 * is required for that largest resolution to avoid remaps at run 654 * time 655 */ 656 if (carminefb_fix.smem_len > CARMINE_TOTAL_DIPLAY_MEM) 657 carminefb_fix.smem_len = CARMINE_TOTAL_DIPLAY_MEM; 658 659 else if (carminefb_fix.smem_len < CARMINE_TOTAL_DIPLAY_MEM) { 660 printk(KERN_ERR "carminefb: Memory bar is only %d bytes, %d " 661 "are required.", carminefb_fix.smem_len, 662 CARMINE_TOTAL_DIPLAY_MEM); 663 goto err_unmap_vregs; 664 } 665 666 if (!request_mem_region(carminefb_fix.smem_start, 667 carminefb_fix.smem_len, "carminefb smem")) { 668 printk(KERN_ERR "carminefb: Can't reserve smem.\n"); 669 goto err_unmap_vregs; 670 } 671 672 hw->screen_mem = ioremap(carminefb_fix.smem_start, 673 carminefb_fix.smem_len); 674 if (!hw->screen_mem) { 675 printk(KERN_ERR "carmine: Can't ioremap smem area.\n"); 676 goto err_reg_smem; 677 } 678 679 ret = init_hardware(hw); 680 if (ret) 681 goto err_unmap_screen; 682 683 info = NULL; 684 if (fb_displays & CARMINE_USE_DISPLAY0) { 685 ret = alloc_carmine_fb(hw->v_regs + CARMINE_DISP0_REG, 686 hw->screen_mem, CARMINE_DISPLAY_MEM * 0, 687 device, &info); 688 if (ret) 689 goto err_deinit_hw; 690 } 691 692 hw->fb[0] = info; 693 694 info = NULL; 695 if (fb_displays & CARMINE_USE_DISPLAY1) { 696 ret = alloc_carmine_fb(hw->v_regs + CARMINE_DISP1_REG, 697 hw->screen_mem, CARMINE_DISPLAY_MEM * 1, 698 device, &info); 699 if (ret) 700 goto err_cleanup_fb0; 701 } 702 703 hw->fb[1] = info; 704 info = NULL; 705 706 pci_set_drvdata(dev, hw); 707 return 0; 708 709 err_cleanup_fb0: 710 cleanup_fb_device(hw->fb[0]); 711 err_deinit_hw: 712 /* disable clock, etc */ 713 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_CLOCK_ENABLE, 0); 714 err_unmap_screen: 715 iounmap(hw->screen_mem); 716 err_reg_smem: 717 release_mem_region(carminefb_fix.smem_start, carminefb_fix.smem_len); 718 err_unmap_vregs: 719 iounmap(hw->v_regs); 720 err_free_reg_mmio: 721 release_mem_region(carminefb_fix.mmio_start, carminefb_fix.mmio_len); 722 err_free_hw: 723 kfree(hw); 724 err_enable_pci: 725 pci_disable_device(dev); 726 return ret; 727 } 728 729 static void carminefb_remove(struct pci_dev *dev) 730 { 731 struct carmine_hw *hw = pci_get_drvdata(dev); 732 struct fb_fix_screeninfo fix; 733 int i; 734 735 /* in case we use only fb1 and not fb1 */ 736 if (hw->fb[0]) 737 fix = hw->fb[0]->fix; 738 else 739 fix = hw->fb[1]->fix; 740 741 /* deactivate display(s) and switch clocks */ 742 c_set_hw_reg(hw, CARMINE_DISP0_REG + CARMINE_DISP_REG_DCM1, 0); 743 c_set_hw_reg(hw, CARMINE_DISP1_REG + CARMINE_DISP_REG_DCM1, 0); 744 c_set_hw_reg(hw, CARMINE_CTL_REG + CARMINE_CTL_REG_CLOCK_ENABLE, 0); 745 746 for (i = 0; i < MAX_DISPLAY; i++) 747 cleanup_fb_device(hw->fb[i]); 748 749 iounmap(hw->screen_mem); 750 release_mem_region(fix.smem_start, fix.smem_len); 751 iounmap(hw->v_regs); 752 release_mem_region(fix.mmio_start, fix.mmio_len); 753 754 pci_disable_device(dev); 755 kfree(hw); 756 } 757 758 #define PCI_VENDOR_ID_FUJITU_LIMITED 0x10cf 759 static struct pci_device_id carmine_devices[] = { 760 { 761 PCI_DEVICE(PCI_VENDOR_ID_FUJITU_LIMITED, 0x202b)}, 762 {0, 0, 0, 0, 0, 0, 0} 763 }; 764 765 MODULE_DEVICE_TABLE(pci, carmine_devices); 766 767 static struct pci_driver carmine_pci_driver = { 768 .name = "carminefb", 769 .id_table = carmine_devices, 770 .probe = carminefb_probe, 771 .remove = carminefb_remove, 772 }; 773 774 static int __init carminefb_init(void) 775 { 776 if (fb_modesetting_disabled("carminefb")) 777 return -ENODEV; 778 779 if (!(fb_displays & 780 (CARMINE_USE_DISPLAY0 | CARMINE_USE_DISPLAY1))) { 781 printk(KERN_ERR "If you disable both displays than you don't " 782 "need the driver at all\n"); 783 return -EINVAL; 784 } 785 return pci_register_driver(&carmine_pci_driver); 786 } 787 module_init(carminefb_init); 788 789 static void __exit carminefb_cleanup(void) 790 { 791 pci_unregister_driver(&carmine_pci_driver); 792 } 793 module_exit(carminefb_cleanup); 794 795 MODULE_AUTHOR("Sebastian Siewior <bigeasy@linutronix.de>"); 796 MODULE_DESCRIPTION("Framebuffer driver for Fujitsu Carmine based devices"); 797 MODULE_LICENSE("GPL v2"); 798