Subversion Repositories or1k

/* $id: p9100fb.c,v 1.4 1999/08/18 10:55:01 shadow Exp $

 * p9100fb.c: P9100 frame buffer driver

 *

 * Copyright 1999 Derrick J Brashear (shadow@dementia.org)

 */

#include <linux/module.h>

#include <linux/sched.h>

#include <linux/kernel.h>

#include <linux/errno.h>

#include <linux/string.h>

#include <linux/mm.h>

#include <linux/tty.h>

#include <linux/slab.h>

#include <linux/vmalloc.h>

#include <linux/delay.h>

#include <linux/interrupt.h>

#include <linux/fb.h>

#include <linux/init.h>

#include <linux/selection.h>

#include <video/sbusfb.h>

#include <asm/io.h>

#include <video/fbcon-cfb8.h>

#include "p9100.h"

static struct sbus_mmap_map p9100_mmap_map[] = {

#if 0 /* For now, play we're a dumb color fb */

  { P9100_CTL_OFF, 0x38000000, 0x2000 },

  { P9100_CMD_OFF, 0x38002000, 0x2000 },

  { P9100_FB_OFF, 0x38800000, 0x200000 },

  { CG3_MMAP_OFFSET, 0x38800000, SBUS_MMAP_FBSIZE(1) },

#else

  { CG3_MMAP_OFFSET, 0x0, SBUS_MMAP_FBSIZE(1) },

#endif

  { 0, 0, 0 }

};

#define _READCTL(member, out) \

{ \

  struct p9100_ctrl *actual; \

  actual = (struct p9100_ctrl *)fb->s.p9100.ctrl; \

  out = sbus_readl(&actual-> ## member ); \

}

#define READCTL(member, out) \

{ \

  struct p9100_ctrl *enab, *actual; \

  actual = (struct p9100_ctrl *)fb->s.p9100.ctrl; \

  enab = (struct p9100_ctrl *)fb->s.p9100.fbmem; \

  out = sbus_readl(&enab-> ## member ); \

  out = sbus_readl(&actual-> ## member ); \

}

#define WRITECTL(member, val) \

{ \

  u32 __writetmp; \

  struct p9100_ctrl *enab, *actual; \

  actual = (struct p9100_ctrl *)fb->s.p9100.ctrl; \

  enab = (struct p9100_ctrl *)fb->s.p9100.fbmem; \

  __writetmp = sbus_readl(&enab-> ## member ); \

  sbus_writel(val, &actual-> ## member ); \

}

static void p9100_loadcmap (struct fb_info_sbusfb *fb, struct display *p, int index, int count)

{

        unsigned long flags;

        u32 tmp;

        int i;

        spin_lock_irqsave(&fb->lock, flags);

        _READCTL(pwrup_cfg, tmp);

        WRITECTL(ramdac_cmap_wridx, (index << 16));

        for (i = index; count--; i++){

                _READCTL(pwrup_cfg, tmp);

                WRITECTL(ramdac_palette_data, (fb->color_map CM(i,0) << 16));

                _READCTL(pwrup_cfg, tmp);

                WRITECTL(ramdac_palette_data, (fb->color_map CM(i,1) << 16));

                _READCTL(pwrup_cfg, tmp);

                WRITECTL(ramdac_palette_data, (fb->color_map CM(i,2) << 16));

        }

        spin_unlock_irqrestore(&fb->lock, flags);

}

static void p9100_blank (struct fb_info_sbusfb *fb)

{

        unsigned long flags;

        u32 val;

        spin_lock_irqsave(&fb->lock, flags);

        READCTL(vid_screenpaint_timectl1, val);

        val &= ~ SCREENPAINT_TIMECTL1_ENABLE_VIDEO;

        WRITECTL(vid_screenpaint_timectl1, val);

        spin_unlock_irqrestore(&fb->lock, flags);

}

static void p9100_unblank (struct fb_info_sbusfb *fb)

{

        unsigned long flags;

        u32 val;

        spin_lock_irqsave(&fb->lock, flags);

        READCTL(vid_screenpaint_timectl1, val);

        val |= SCREENPAINT_TIMECTL1_ENABLE_VIDEO;

        WRITECTL(vid_screenpaint_timectl1, val);

        spin_unlock_irqrestore(&fb->lock, flags);

}

static void p9100_margins (struct fb_info_sbusfb *fb, struct display *p, int x_margin, int y_margin)

{

  p->screen_base += (y_margin - fb->y_margin) * p->line_length +

    (x_margin - fb->x_margin);

}

static char idstring[60] __initdata = { 0 };

char * __init p9100fb_init(struct fb_info_sbusfb *fb)

{

        struct fb_fix_screeninfo *fix = &fb->fix;

        struct display *disp = &fb->disp;

        struct fbtype *type = &fb->type;

        struct sbus_dev *sdev = fb->sbdp;

        unsigned long phys = sdev->reg_addrs[2].phys_addr;

        int tmp;

#ifndef FBCON_HAS_CFB8

        return NULL;

#endif

        /* Control regs: fb->sbdp->reg_addrs[0].phys_addr

         * Command regs: fb->sbdp->reg_addrs[1].phys_addr

         * Frame buffer: fb->sbdp->reg_addrs[2].phys_addr

         */

        if (!fb->s.p9100.ctrl) {

                fb->s.p9100.ctrl = (struct p9100_ctrl *)

                        sbus_ioremap(&sdev->resource[0], 0,

                                     sdev->reg_addrs[0].reg_size, "p9100 ctrl");

        }

        strcpy(fb->info.modename, "p9100");

        strcpy(fix->id, "p9100");

        fix->accel = FB_ACCEL_SUN_CGTHREE;

        fix->line_length = fb->var.xres_virtual;

        disp->scrollmode = SCROLL_YREDRAW;

        if (!disp->screen_base)

                disp->screen_base = (char *)

                        sbus_ioremap(&sdev->resource[2], 0,

                                     type->fb_size, "p9100 ram");

        fb->s.p9100.fbmem = (volatile u32 *)disp->screen_base;

        disp->screen_base += fix->line_length * fb->y_margin + fb->x_margin;

        READCTL(sys_config, tmp);

        switch ((tmp >> SYS_CONFIG_PIXELSIZE_SHIFT) & 7) {

        case 7:

          type->fb_depth = 24;

          break;

        case 5:

          type->fb_depth = 32;

          break;

        case 3:

          type->fb_depth = 16;

          break;

        case 2:

          type->fb_depth = 8;

          break;

        default:

          printk("p9100: screen depth unknown: 0x%x", tmp);

          return NULL;

        }

        fb->dispsw = fbcon_cfb8;

        fb->margins = p9100_margins;

        fb->loadcmap = p9100_loadcmap;

        fb->blank = p9100_blank;

        fb->unblank = p9100_unblank;

        fb->physbase = phys;

        fb->mmap_map = p9100_mmap_map;

        sprintf(idstring, "%s at 0x%x", "p9100",

                (unsigned int)disp->screen_base);

        return idstring;

}