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