|
|
@@ -8,6 +8,7 @@
|
|
|
* and Harald Koerfgen <hkoerfg@web.de>, which itself is derived from
|
|
|
* "HP300 Topcat framebuffer support (derived from macfb of all things)
|
|
|
* Phil Blundell <philb@gnu.org> 1998"
|
|
|
+ * Copyright (c) 2016 Maciej W. Rozycki
|
|
|
*
|
|
|
* This file is subject to the terms and conditions of the GNU General
|
|
|
* Public License. See the file COPYING in the main directory of this
|
|
|
@@ -21,37 +22,29 @@
|
|
|
*
|
|
|
* 2003-09-21 Thiemo Seufer <seufer@csv.ica.uni-stuttgart.de>
|
|
|
* Hardware cursor support.
|
|
|
+ *
|
|
|
+ * 2016-02-21 Maciej W. Rozycki <macro@linux-mips.org>
|
|
|
+ * Version 0.03: Rewritten for the new FB and TC APIs.
|
|
|
*/
|
|
|
-#include <linux/module.h>
|
|
|
-#include <linux/kernel.h>
|
|
|
+
|
|
|
+#include <linux/compiler.h>
|
|
|
#include <linux/errno.h>
|
|
|
-#include <linux/string.h>
|
|
|
-#include <linux/timer.h>
|
|
|
-#include <linux/mm.h>
|
|
|
-#include <linux/delay.h>
|
|
|
-#include <linux/init.h>
|
|
|
#include <linux/fb.h>
|
|
|
-#include <linux/console.h>
|
|
|
-
|
|
|
-#include <asm/bootinfo.h>
|
|
|
-#include <asm/dec/machtype.h>
|
|
|
-#include <asm/dec/tc.h>
|
|
|
-
|
|
|
-#include <video/fbcon.h>
|
|
|
-#include <video/fbcon-cfb8.h>
|
|
|
+#include <linux/init.h>
|
|
|
+#include <linux/io.h>
|
|
|
+#include <linux/kernel.h>
|
|
|
+#include <linux/module.h>
|
|
|
+#include <linux/tc.h>
|
|
|
+#include <linux/timer.h>
|
|
|
|
|
|
#include "bt455.h"
|
|
|
#include "bt431.h"
|
|
|
|
|
|
/* Version information */
|
|
|
-#define DRIVER_VERSION "0.02"
|
|
|
+#define DRIVER_VERSION "0.03"
|
|
|
#define DRIVER_AUTHOR "Karsten Merker <merker@linuxtag.org>"
|
|
|
#define DRIVER_DESCRIPTION "PMAG-AA Framebuffer Driver"
|
|
|
|
|
|
-/* Prototypes */
|
|
|
-static int aafb_set_var(struct fb_var_screeninfo *var, int con,
|
|
|
- struct fb_info *info);
|
|
|
-
|
|
|
/*
|
|
|
* Bt455 RAM DAC register base offset (rel. to TC slot base address).
|
|
|
*/
|
|
|
@@ -68,443 +61,246 @@ static int aafb_set_var(struct fb_var_screeninfo *var, int con,
|
|
|
*/
|
|
|
#define PMAG_AA_ONBOARD_FBMEM_OFFSET 0x200000
|
|
|
|
|
|
-struct aafb_cursor {
|
|
|
- struct timer_list timer;
|
|
|
- int enable;
|
|
|
- int on;
|
|
|
- int vbl_cnt;
|
|
|
- int blink_rate;
|
|
|
- u16 x, y, width, height;
|
|
|
+struct aafb_par {
|
|
|
+ void __iomem *mmio;
|
|
|
+ struct bt455_regs __iomem *bt455;
|
|
|
+ struct bt431_regs __iomem *bt431;
|
|
|
};
|
|
|
|
|
|
-#define CURSOR_TIMER_FREQ (HZ / 50)
|
|
|
-#define CURSOR_BLINK_RATE (20)
|
|
|
-#define CURSOR_DRAW_DELAY (2)
|
|
|
-
|
|
|
-struct aafb_info {
|
|
|
- struct fb_info info;
|
|
|
- struct display disp;
|
|
|
- struct aafb_cursor cursor;
|
|
|
- struct bt455_regs *bt455;
|
|
|
- struct bt431_regs *bt431;
|
|
|
- unsigned long fb_start;
|
|
|
- unsigned long fb_size;
|
|
|
- unsigned long fb_line_length;
|
|
|
+static struct fb_var_screeninfo aafb_defined = {
|
|
|
+ .xres = 1280,
|
|
|
+ .yres = 1024,
|
|
|
+ .xres_virtual = 2048,
|
|
|
+ .yres_virtual = 1024,
|
|
|
+ .bits_per_pixel = 8,
|
|
|
+ .grayscale = 1,
|
|
|
+ .red.length = 0,
|
|
|
+ .green.length = 1,
|
|
|
+ .blue.length = 0,
|
|
|
+ .activate = FB_ACTIVATE_NOW,
|
|
|
+ .accel_flags = FB_ACCEL_NONE,
|
|
|
+ .pixclock = 7645,
|
|
|
+ .left_margin = 224,
|
|
|
+ .right_margin = 32,
|
|
|
+ .upper_margin = 33,
|
|
|
+ .lower_margin = 3,
|
|
|
+ .hsync_len = 160,
|
|
|
+ .vsync_len = 3,
|
|
|
+ .sync = FB_SYNC_ON_GREEN,
|
|
|
+ .vmode = FB_VMODE_NONINTERLACED,
|
|
|
};
|
|
|
|
|
|
-/*
|
|
|
- * Max 3 TURBOchannel slots -> max 3 PMAG-AA.
|
|
|
- */
|
|
|
-static struct aafb_info my_fb_info[3];
|
|
|
-
|
|
|
-static struct aafb_par {
|
|
|
-} current_par;
|
|
|
-
|
|
|
-static int currcon = -1;
|
|
|
-
|
|
|
-static void aafb_set_cursor(struct aafb_info *info, int on)
|
|
|
-{
|
|
|
- struct aafb_cursor *c = &info->cursor;
|
|
|
-
|
|
|
- if (on) {
|
|
|
- bt431_position_cursor(info->bt431, c->x, c->y);
|
|
|
- bt431_enable_cursor(info->bt431);
|
|
|
- } else
|
|
|
- bt431_erase_cursor(info->bt431);
|
|
|
-}
|
|
|
-
|
|
|
-static void aafbcon_cursor(struct display *disp, int mode, int x, int y)
|
|
|
-{
|
|
|
- struct aafb_info *info = (struct aafb_info *)disp->fb_info;
|
|
|
- struct aafb_cursor *c = &info->cursor;
|
|
|
-
|
|
|
- x *= fontwidth(disp);
|
|
|
- y *= fontheight(disp);
|
|
|
-
|
|
|
- if (c->x == x && c->y == y && (mode == CM_ERASE) == !c->enable)
|
|
|
- return;
|
|
|
-
|
|
|
- c->enable = 0;
|
|
|
- if (c->on)
|
|
|
- aafb_set_cursor(info, 0);
|
|
|
- c->x = x - disp->var.xoffset;
|
|
|
- c->y = y - disp->var.yoffset;
|
|
|
-
|
|
|
- switch (mode) {
|
|
|
- case CM_ERASE:
|
|
|
- c->on = 0;
|
|
|
- break;
|
|
|
- case CM_DRAW:
|
|
|
- case CM_MOVE:
|
|
|
- if (c->on)
|
|
|
- aafb_set_cursor(info, c->on);
|
|
|
- else
|
|
|
- c->vbl_cnt = CURSOR_DRAW_DELAY;
|
|
|
- c->enable = 1;
|
|
|
- break;
|
|
|
- }
|
|
|
-}
|
|
|
+static struct fb_fix_screeninfo aafb_fix = {
|
|
|
+ .id = "PMAG-AA",
|
|
|
+ .smem_len = (2048 * 1024),
|
|
|
+ .type = FB_TYPE_PACKED_PIXELS,
|
|
|
+ .visual = FB_VISUAL_MONO10,
|
|
|
+ .ypanstep = 1,
|
|
|
+ .ywrapstep = 1,
|
|
|
+ .line_length = 2048,
|
|
|
+ .mmio_len = PMAG_AA_ONBOARD_FBMEM_OFFSET - PMAG_AA_BT455_OFFSET,
|
|
|
+};
|
|
|
|
|
|
-static int aafbcon_set_font(struct display *disp, int width, int height)
|
|
|
+static int aafb_cursor(struct fb_info *info, struct fb_cursor *cursor)
|
|
|
{
|
|
|
- struct aafb_info *info = (struct aafb_info *)disp->fb_info;
|
|
|
- struct aafb_cursor *c = &info->cursor;
|
|
|
- u8 fgc = ~attr_bgcol_ec(disp, disp->conp, &info->info);
|
|
|
+ struct aafb_par *par = info->par;
|
|
|
|
|
|
- if (width > 64 || height > 64 || width < 0 || height < 0)
|
|
|
+ if (cursor->image.height > BT431_CURSOR_SIZE ||
|
|
|
+ cursor->image.width > BT431_CURSOR_SIZE) {
|
|
|
+ bt431_erase_cursor(par->bt431);
|
|
|
return -EINVAL;
|
|
|
-
|
|
|
- c->height = height;
|
|
|
- c->width = width;
|
|
|
-
|
|
|
- bt431_set_font(info->bt431, fgc, width, height);
|
|
|
-
|
|
|
- return 1;
|
|
|
-}
|
|
|
-
|
|
|
-static void aafb_cursor_timer_handler(unsigned long data)
|
|
|
-{
|
|
|
- struct aafb_info *info = (struct aafb_info *)data;
|
|
|
- struct aafb_cursor *c = &info->cursor;
|
|
|
-
|
|
|
- if (!c->enable)
|
|
|
- goto out;
|
|
|
-
|
|
|
- if (c->vbl_cnt && --c->vbl_cnt == 0) {
|
|
|
- c->on ^= 1;
|
|
|
- aafb_set_cursor(info, c->on);
|
|
|
- c->vbl_cnt = c->blink_rate;
|
|
|
}
|
|
|
|
|
|
-out:
|
|
|
- c->timer.expires = jiffies + CURSOR_TIMER_FREQ;
|
|
|
- add_timer(&c->timer);
|
|
|
-}
|
|
|
-
|
|
|
-static void __init aafb_cursor_init(struct aafb_info *info)
|
|
|
-{
|
|
|
- struct aafb_cursor *c = &info->cursor;
|
|
|
-
|
|
|
- c->enable = 1;
|
|
|
- c->on = 1;
|
|
|
- c->x = c->y = 0;
|
|
|
- c->width = c->height = 0;
|
|
|
- c->vbl_cnt = CURSOR_DRAW_DELAY;
|
|
|
- c->blink_rate = CURSOR_BLINK_RATE;
|
|
|
-
|
|
|
- init_timer(&c->timer);
|
|
|
- c->timer.data = (unsigned long)info;
|
|
|
- c->timer.function = aafb_cursor_timer_handler;
|
|
|
- mod_timer(&c->timer, jiffies + CURSOR_TIMER_FREQ);
|
|
|
-}
|
|
|
-
|
|
|
-static void __exit aafb_cursor_exit(struct aafb_info *info)
|
|
|
-{
|
|
|
- struct aafb_cursor *c = &info->cursor;
|
|
|
-
|
|
|
- del_timer_sync(&c->timer);
|
|
|
-}
|
|
|
-
|
|
|
-static struct display_switch aafb_switch8 = {
|
|
|
- .setup = fbcon_cfb8_setup,
|
|
|
- .bmove = fbcon_cfb8_bmove,
|
|
|
- .clear = fbcon_cfb8_clear,
|
|
|
- .putc = fbcon_cfb8_putc,
|
|
|
- .putcs = fbcon_cfb8_putcs,
|
|
|
- .revc = fbcon_cfb8_revc,
|
|
|
- .cursor = aafbcon_cursor,
|
|
|
- .set_font = aafbcon_set_font,
|
|
|
- .clear_margins = fbcon_cfb8_clear_margins,
|
|
|
- .fontwidthmask = FONTWIDTH(4)|FONTWIDTH(8)|FONTWIDTH(12)|FONTWIDTH(16)
|
|
|
-};
|
|
|
-
|
|
|
-static void aafb_get_par(struct aafb_par *par)
|
|
|
-{
|
|
|
- *par = current_par;
|
|
|
-}
|
|
|
-
|
|
|
-static int aafb_get_fix(struct fb_fix_screeninfo *fix, int con,
|
|
|
- struct fb_info *info)
|
|
|
-{
|
|
|
- struct aafb_info *ip = (struct aafb_info *)info;
|
|
|
-
|
|
|
- memset(fix, 0, sizeof(struct fb_fix_screeninfo));
|
|
|
- strcpy(fix->id, "PMAG-AA");
|
|
|
- fix->smem_start = ip->fb_start;
|
|
|
- fix->smem_len = ip->fb_size;
|
|
|
- fix->type = FB_TYPE_PACKED_PIXELS;
|
|
|
- fix->ypanstep = 1;
|
|
|
- fix->ywrapstep = 1;
|
|
|
- fix->visual = FB_VISUAL_MONO10;
|
|
|
- fix->line_length = 1280;
|
|
|
- fix->accel = FB_ACCEL_NONE;
|
|
|
+ if (!cursor->enable)
|
|
|
+ bt431_erase_cursor(par->bt431);
|
|
|
|
|
|
- return 0;
|
|
|
-}
|
|
|
+ if (cursor->set & FB_CUR_SETPOS)
|
|
|
+ bt431_position_cursor(par->bt431,
|
|
|
+ cursor->image.dx, cursor->image.dy);
|
|
|
+ if (cursor->set & FB_CUR_SETCMAP) {
|
|
|
+ u8 fg = cursor->image.fg_color ? 0xf : 0x0;
|
|
|
+ u8 bg = cursor->image.bg_color ? 0xf : 0x0;
|
|
|
|
|
|
-static void aafb_set_disp(struct display *disp, int con,
|
|
|
- struct aafb_info *info)
|
|
|
-{
|
|
|
- struct fb_fix_screeninfo fix;
|
|
|
-
|
|
|
- disp->fb_info = &info->info;
|
|
|
- aafb_set_var(&disp->var, con, &info->info);
|
|
|
- if (disp->conp && disp->conp->vc_sw && disp->conp->vc_sw->con_cursor)
|
|
|
- disp->conp->vc_sw->con_cursor(disp->conp, CM_ERASE);
|
|
|
- disp->dispsw = &aafb_switch8;
|
|
|
- disp->dispsw_data = 0;
|
|
|
-
|
|
|
- aafb_get_fix(&fix, con, &info->info);
|
|
|
- disp->screen_base = (u8 *) fix.smem_start;
|
|
|
- disp->visual = fix.visual;
|
|
|
- disp->type = fix.type;
|
|
|
- disp->type_aux = fix.type_aux;
|
|
|
- disp->ypanstep = fix.ypanstep;
|
|
|
- disp->ywrapstep = fix.ywrapstep;
|
|
|
- disp->line_length = fix.line_length;
|
|
|
- disp->next_line = 2048;
|
|
|
- disp->can_soft_blank = 1;
|
|
|
- disp->inverse = 0;
|
|
|
- disp->scrollmode = SCROLL_YREDRAW;
|
|
|
-
|
|
|
- aafbcon_set_font(disp, fontwidth(disp), fontheight(disp));
|
|
|
-}
|
|
|
+ bt455_write_cmap_entry(par->bt455, 8, bg);
|
|
|
+ bt455_write_cmap_next(par->bt455, bg);
|
|
|
+ bt455_write_ovly_next(par->bt455, fg);
|
|
|
+ }
|
|
|
+ if (cursor->set & (FB_CUR_SETSIZE | FB_CUR_SETSHAPE | FB_CUR_SETIMAGE))
|
|
|
+ bt431_set_cursor(par->bt431,
|
|
|
+ cursor->image.data, cursor->mask, cursor->rop,
|
|
|
+ cursor->image.width, cursor->image.height);
|
|
|
|
|
|
-static int aafb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
|
|
|
- struct fb_info *info)
|
|
|
-{
|
|
|
- static u16 color[2] = {0x0000, 0x000f};
|
|
|
- static struct fb_cmap aafb_cmap = {0, 2, color, color, color, NULL};
|
|
|
+ if (cursor->enable)
|
|
|
+ bt431_enable_cursor(par->bt431);
|
|
|
|
|
|
- fb_copy_cmap(&aafb_cmap, cmap, kspc ? 0 : 2);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-static int aafb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
|
|
|
- struct fb_info *info)
|
|
|
-{
|
|
|
- u16 color[2] = {0x0000, 0x000f};
|
|
|
-
|
|
|
- if (cmap->start == 0
|
|
|
- && cmap->len == 2
|
|
|
- && memcmp(cmap->red, color, sizeof(color)) == 0
|
|
|
- && memcmp(cmap->green, color, sizeof(color)) == 0
|
|
|
- && memcmp(cmap->blue, color, sizeof(color)) == 0
|
|
|
- && cmap->transp == NULL)
|
|
|
- return 0;
|
|
|
- else
|
|
|
- return -EINVAL;
|
|
|
-}
|
|
|
-
|
|
|
-static int aafb_ioctl(struct fb_info *info, u32 cmd, unsigned long arg)
|
|
|
-{
|
|
|
- /* TODO: Not yet implemented */
|
|
|
- return -ENOIOCTLCMD;
|
|
|
-}
|
|
|
+/* 0 unblanks, any other blanks. */
|
|
|
|
|
|
-static int aafb_switch(int con, struct fb_info *info)
|
|
|
+static int aafb_blank(int blank, struct fb_info *info)
|
|
|
{
|
|
|
- struct aafb_info *ip = (struct aafb_info *)info;
|
|
|
- struct display *old = (currcon < 0) ? &ip->disp : (fb_display + currcon);
|
|
|
- struct display *new = (con < 0) ? &ip->disp : (fb_display + con);
|
|
|
-
|
|
|
- if (old->conp && old->conp->vc_sw && old->conp->vc_sw->con_cursor)
|
|
|
- old->conp->vc_sw->con_cursor(old->conp, CM_ERASE);
|
|
|
-
|
|
|
- /* Set the current console. */
|
|
|
- currcon = con;
|
|
|
- aafb_set_disp(new, con, ip);
|
|
|
+ struct aafb_par *par = info->par;
|
|
|
+ u8 val = blank ? 0x00 : 0x0f;
|
|
|
|
|
|
+ bt455_write_cmap_entry(par->bt455, 1, val);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-static void aafb_encode_var(struct fb_var_screeninfo *var,
|
|
|
- struct aafb_par *par)
|
|
|
-{
|
|
|
- var->xres = 1280;
|
|
|
- var->yres = 1024;
|
|
|
- var->xres_virtual = 2048;
|
|
|
- var->yres_virtual = 1024;
|
|
|
- var->xoffset = 0;
|
|
|
- var->yoffset = 0;
|
|
|
- var->bits_per_pixel = 8;
|
|
|
- var->grayscale = 1;
|
|
|
- var->red.offset = 0;
|
|
|
- var->red.length = 0;
|
|
|
- var->red.msb_right = 0;
|
|
|
- var->green.offset = 0;
|
|
|
- var->green.length = 1;
|
|
|
- var->green.msb_right = 0;
|
|
|
- var->blue.offset = 0;
|
|
|
- var->blue.length = 0;
|
|
|
- var->blue.msb_right = 0;
|
|
|
- var->transp.offset = 0;
|
|
|
- var->transp.length = 0;
|
|
|
- var->transp.msb_right = 0;
|
|
|
- var->nonstd = 0;
|
|
|
- var->activate &= ~FB_ACTIVATE_MASK & FB_ACTIVATE_NOW;
|
|
|
- var->accel_flags = 0;
|
|
|
- var->sync = FB_SYNC_ON_GREEN;
|
|
|
- var->vmode &= ~FB_VMODE_MASK & FB_VMODE_NONINTERLACED;
|
|
|
-}
|
|
|
+static struct fb_ops aafb_ops = {
|
|
|
+ .owner = THIS_MODULE,
|
|
|
+ .fb_blank = aafb_blank,
|
|
|
+ .fb_fillrect = cfb_fillrect,
|
|
|
+ .fb_copyarea = cfb_copyarea,
|
|
|
+ .fb_imageblit = cfb_imageblit,
|
|
|
+ .fb_cursor = aafb_cursor,
|
|
|
+};
|
|
|
|
|
|
-static int aafb_get_var(struct fb_var_screeninfo *var, int con,
|
|
|
- struct fb_info *info)
|
|
|
+static int pmagaafb_probe(struct device *dev)
|
|
|
{
|
|
|
- if (con < 0) {
|
|
|
- struct aafb_par par;
|
|
|
-
|
|
|
- memset(var, 0, sizeof(struct fb_var_screeninfo));
|
|
|
- aafb_get_par(&par);
|
|
|
- aafb_encode_var(var, &par);
|
|
|
- } else
|
|
|
- *var = info->var;
|
|
|
+ struct tc_dev *tdev = to_tc_dev(dev);
|
|
|
+ resource_size_t start, len;
|
|
|
+ struct fb_info *info;
|
|
|
+ struct aafb_par *par;
|
|
|
+ int err;
|
|
|
+
|
|
|
+ info = framebuffer_alloc(sizeof(struct aafb_par), dev);
|
|
|
+ if (!info) {
|
|
|
+ printk(KERN_ERR "%s: Cannot allocate memory\n", dev_name(dev));
|
|
|
+ return -ENOMEM;
|
|
|
+ }
|
|
|
|
|
|
- return 0;
|
|
|
-}
|
|
|
+ par = info->par;
|
|
|
+ dev_set_drvdata(dev, info);
|
|
|
+
|
|
|
+ info->fbops = &aafb_ops;
|
|
|
+ info->fix = aafb_fix;
|
|
|
+ info->var = aafb_defined;
|
|
|
+ info->flags = FBINFO_DEFAULT;
|
|
|
+
|
|
|
+ /* Request the I/O MEM resource. */
|
|
|
+ start = tdev->resource.start;
|
|
|
+ len = tdev->resource.end - start + 1;
|
|
|
+ if (!request_mem_region(start, len, dev_name(dev))) {
|
|
|
+ printk(KERN_ERR "%s: Cannot reserve FB region\n",
|
|
|
+ dev_name(dev));
|
|
|
+ err = -EBUSY;
|
|
|
+ goto err_alloc;
|
|
|
+ }
|
|
|
|
|
|
-static int aafb_set_var(struct fb_var_screeninfo *var, int con,
|
|
|
- struct fb_info *info)
|
|
|
-{
|
|
|
- struct aafb_par par;
|
|
|
+ /* MMIO mapping setup. */
|
|
|
+ info->fix.mmio_start = start + PMAG_AA_BT455_OFFSET;
|
|
|
+ par->mmio = ioremap_nocache(info->fix.mmio_start, info->fix.mmio_len);
|
|
|
+ if (!par->mmio) {
|
|
|
+ printk(KERN_ERR "%s: Cannot map MMIO\n", dev_name(dev));
|
|
|
+ err = -ENOMEM;
|
|
|
+ goto err_resource;
|
|
|
+ }
|
|
|
+ par->bt455 = par->mmio - PMAG_AA_BT455_OFFSET + PMAG_AA_BT455_OFFSET;
|
|
|
+ par->bt431 = par->mmio - PMAG_AA_BT455_OFFSET + PMAG_AA_BT431_OFFSET;
|
|
|
+
|
|
|
+ /* Frame buffer mapping setup. */
|
|
|
+ info->fix.smem_start = start + PMAG_AA_ONBOARD_FBMEM_OFFSET;
|
|
|
+ info->screen_base = ioremap_nocache(info->fix.smem_start,
|
|
|
+ info->fix.smem_len);
|
|
|
+ if (!info->screen_base) {
|
|
|
+ printk(KERN_ERR "%s: Cannot map FB\n", dev_name(dev));
|
|
|
+ err = -ENOMEM;
|
|
|
+ goto err_mmio_map;
|
|
|
+ }
|
|
|
+ info->screen_size = info->fix.smem_len;
|
|
|
|
|
|
- aafb_get_par(&par);
|
|
|
- aafb_encode_var(var, &par);
|
|
|
- info->var = *var;
|
|
|
+ /* Init colormap. */
|
|
|
+ bt455_write_cmap_entry(par->bt455, 0, 0x0);
|
|
|
+ bt455_write_cmap_next(par->bt455, 0xf);
|
|
|
|
|
|
- return 0;
|
|
|
-}
|
|
|
+ /* Init hardware cursor. */
|
|
|
+ bt431_erase_cursor(par->bt431);
|
|
|
+ bt431_init_cursor(par->bt431);
|
|
|
+
|
|
|
+ err = register_framebuffer(info);
|
|
|
+ if (err < 0) {
|
|
|
+ printk(KERN_ERR "%s: Cannot register framebuffer\n",
|
|
|
+ dev_name(dev));
|
|
|
+ goto err_smem_map;
|
|
|
+ }
|
|
|
|
|
|
-static int aafb_update_var(int con, struct fb_info *info)
|
|
|
-{
|
|
|
- struct aafb_info *ip = (struct aafb_info *)info;
|
|
|
- struct display *disp = (con < 0) ? &ip->disp : (fb_display + con);
|
|
|
+ get_device(dev);
|
|
|
|
|
|
- if (con == currcon)
|
|
|
- aafbcon_cursor(disp, CM_ERASE, ip->cursor.x, ip->cursor.y);
|
|
|
+ pr_info("fb%d: %s frame buffer device at %s\n",
|
|
|
+ info->node, info->fix.id, dev_name(dev));
|
|
|
|
|
|
return 0;
|
|
|
-}
|
|
|
|
|
|
-/* 0 unblanks, any other blanks. */
|
|
|
|
|
|
-static void aafb_blank(int blank, struct fb_info *info)
|
|
|
-{
|
|
|
- struct aafb_info *ip = (struct aafb_info *)info;
|
|
|
- u8 val = blank ? 0x00 : 0x0f;
|
|
|
+err_smem_map:
|
|
|
+ iounmap(info->screen_base);
|
|
|
|
|
|
- bt455_write_cmap_entry(ip->bt455, 1, val, val, val);
|
|
|
- aafbcon_cursor(&ip->disp, CM_ERASE, ip->cursor.x, ip->cursor.y);
|
|
|
-}
|
|
|
+err_mmio_map:
|
|
|
+ iounmap(par->mmio);
|
|
|
|
|
|
-static struct fb_ops aafb_ops = {
|
|
|
- .owner = THIS_MODULE,
|
|
|
- .fb_get_fix = aafb_get_fix,
|
|
|
- .fb_get_var = aafb_get_var,
|
|
|
- .fb_set_var = aafb_set_var,
|
|
|
- .fb_get_cmap = aafb_get_cmap,
|
|
|
- .fb_set_cmap = aafb_set_cmap,
|
|
|
- .fb_ioctl = aafb_ioctl
|
|
|
-};
|
|
|
+err_resource:
|
|
|
+ release_mem_region(start, len);
|
|
|
|
|
|
-static int __init init_one(int slot)
|
|
|
-{
|
|
|
- unsigned long base_addr = CKSEG1ADDR(get_tc_base_addr(slot));
|
|
|
- struct aafb_info *ip = &my_fb_info[slot];
|
|
|
-
|
|
|
- memset(ip, 0, sizeof(struct aafb_info));
|
|
|
-
|
|
|
- /*
|
|
|
- * Framebuffer display memory base address and friends.
|
|
|
- */
|
|
|
- ip->bt455 = (struct bt455_regs *) (base_addr + PMAG_AA_BT455_OFFSET);
|
|
|
- ip->bt431 = (struct bt431_regs *) (base_addr + PMAG_AA_BT431_OFFSET);
|
|
|
- ip->fb_start = base_addr + PMAG_AA_ONBOARD_FBMEM_OFFSET;
|
|
|
- ip->fb_size = 2048 * 1024; /* fb_fix_screeninfo.smem_length
|
|
|
- seems to be physical */
|
|
|
- ip->fb_line_length = 2048;
|
|
|
-
|
|
|
- /*
|
|
|
- * Let there be consoles..
|
|
|
- */
|
|
|
- strcpy(ip->info.modename, "PMAG-AA");
|
|
|
- ip->info.node = -1;
|
|
|
- ip->info.flags = FBINFO_FLAG_DEFAULT;
|
|
|
- ip->info.fbops = &aafb_ops;
|
|
|
- ip->info.disp = &ip->disp;
|
|
|
- ip->info.changevar = NULL;
|
|
|
- ip->info.switch_con = &aafb_switch;
|
|
|
- ip->info.updatevar = &aafb_update_var;
|
|
|
- ip->info.blank = &aafb_blank;
|
|
|
-
|
|
|
- aafb_set_disp(&ip->disp, currcon, ip);
|
|
|
-
|
|
|
- /*
|
|
|
- * Configure the RAM DACs.
|
|
|
- */
|
|
|
- bt455_erase_cursor(ip->bt455);
|
|
|
-
|
|
|
- /* Init colormap. */
|
|
|
- bt455_write_cmap_entry(ip->bt455, 0, 0x00, 0x00, 0x00);
|
|
|
- bt455_write_cmap_entry(ip->bt455, 1, 0x0f, 0x0f, 0x0f);
|
|
|
-
|
|
|
- /* Init hardware cursor. */
|
|
|
- bt431_init_cursor(ip->bt431);
|
|
|
- aafb_cursor_init(ip);
|
|
|
-
|
|
|
- /* Clear the screen. */
|
|
|
- memset ((void *)ip->fb_start, 0, ip->fb_size);
|
|
|
-
|
|
|
- if (register_framebuffer(&ip->info) < 0)
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
- printk(KERN_INFO "fb%d: %s frame buffer in TC slot %d\n",
|
|
|
- GET_FB_IDX(ip->info.node), ip->info.modename, slot);
|
|
|
-
|
|
|
- return 0;
|
|
|
+err_alloc:
|
|
|
+ framebuffer_release(info);
|
|
|
+ return err;
|
|
|
}
|
|
|
|
|
|
-static int __exit exit_one(int slot)
|
|
|
+static int __exit pmagaafb_remove(struct device *dev)
|
|
|
{
|
|
|
- struct aafb_info *ip = &my_fb_info[slot];
|
|
|
-
|
|
|
- if (unregister_framebuffer(&ip->info) < 0)
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
+ struct tc_dev *tdev = to_tc_dev(dev);
|
|
|
+ struct fb_info *info = dev_get_drvdata(dev);
|
|
|
+ struct aafb_par *par = info->par;
|
|
|
+ resource_size_t start, len;
|
|
|
+
|
|
|
+ put_device(dev);
|
|
|
+ unregister_framebuffer(info);
|
|
|
+ iounmap(info->screen_base);
|
|
|
+ iounmap(par->mmio);
|
|
|
+ start = tdev->resource.start;
|
|
|
+ len = tdev->resource.end - start + 1;
|
|
|
+ release_mem_region(start, len);
|
|
|
+ framebuffer_release(info);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
/*
|
|
|
* Initialise the framebuffer.
|
|
|
*/
|
|
|
-int __init pmagaafb_init(void)
|
|
|
-{
|
|
|
- int sid;
|
|
|
- int found = 0;
|
|
|
-
|
|
|
- while ((sid = search_tc_card("PMAG-AA")) >= 0) {
|
|
|
- found = 1;
|
|
|
- claim_tc_card(sid);
|
|
|
- init_one(sid);
|
|
|
- }
|
|
|
+static const struct tc_device_id pmagaafb_tc_table[] = {
|
|
|
+ { "DEC ", "PMAG-AA " },
|
|
|
+ { }
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(tc, pmagaafb_tc_table);
|
|
|
+
|
|
|
+static struct tc_driver pmagaafb_driver = {
|
|
|
+ .id_table = pmagaafb_tc_table,
|
|
|
+ .driver = {
|
|
|
+ .name = "pmagaafb",
|
|
|
+ .bus = &tc_bus_type,
|
|
|
+ .probe = pmagaafb_probe,
|
|
|
+ .remove = __exit_p(pmagaafb_remove),
|
|
|
+ },
|
|
|
+};
|
|
|
|
|
|
- return found ? 0 : -ENXIO;
|
|
|
+static int __init pmagaafb_init(void)
|
|
|
+{
|
|
|
+#ifndef MODULE
|
|
|
+ if (fb_get_options("pmagaafb", NULL))
|
|
|
+ return -ENXIO;
|
|
|
+#endif
|
|
|
+ return tc_register_driver(&pmagaafb_driver);
|
|
|
}
|
|
|
|
|
|
static void __exit pmagaafb_exit(void)
|
|
|
{
|
|
|
- int sid;
|
|
|
-
|
|
|
- while ((sid = search_tc_card("PMAG-AA")) >= 0) {
|
|
|
- exit_one(sid);
|
|
|
- release_tc_card(sid);
|
|
|
- }
|
|
|
+ tc_unregister_driver(&pmagaafb_driver);
|
|
|
}
|
|
|
|
|
|
+module_init(pmagaafb_init);
|
|
|
+module_exit(pmagaafb_exit);
|
|
|
+
|
|
|
MODULE_AUTHOR(DRIVER_AUTHOR);
|
|
|
MODULE_DESCRIPTION(DRIVER_DESCRIPTION);
|
|
|
MODULE_LICENSE("GPL");
|
|
|
-#ifdef MODULE
|
|
|
-module_init(pmagaafb_init);
|
|
|
-module_exit(pmagaafb_exit);
|
|
|
-#endif
|
Linus Torvalds