/* Copyright (C) 2012, Aaron Lindsay This file is part of Aedrix. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. */ #include #include #include #include #include #include #define PL111_CR_EN 0x001 #define PL111_CR_PWR 0x800 #define PL111_IOBASE 0x10020000 #define PL111_PALBASE (PL111_IOBASE + 0x200) struct pl111_control { uint32 volatile timing0; //0 uint32 volatile timing1; //4 uint32 volatile timing2; //8 uint32 volatile timing3; //c uint32 volatile upbase; //10 uint32 volatile lpbase; //14 uint32 volatile control; //18 }; struct fbdev pl111_fb_device; int pl111_init_dev(struct fb *f, unsigned int color_depth) { unsigned int width, height; unsigned int fb_size, power; struct pl111_control *plio = (struct pl111_control*)PL111_IOBASE; struct page *p; /* 640x480 pixels */ width = 640; height = 480; plio->timing0 = 0x3f1f3f9c; plio->timing1 = 0x080b61df; /* Allocate memory for framebuffer */ fb_size = width * height * (color_depth / 8); power = log(fb_size) - log(MM_PAGE_SIZE); if ((unsigned int)1<upbase = (uint32)p->address; if (color_depth == FB_COLOR_DEPTH_8) { plio->control = 0x1827; } else if (color_depth == FB_COLOR_DEPTH_16) { plio->control = 0x1829; } else if (color_depth == FB_COLOR_DEPTH_24) { plio->control = 0x182B; } else { //assume 16 if nothing else fit color_depth = 16; plio->control = 0x1829; } f->device = &pl111_fb_device; f->device->fbaddr = (void*)plio->upbase; f->width = width; f->device->pixelwidth = width; f->height = height; f->device->pixelheight = height; f->color_depth = color_depth; f->device->color_depth = color_depth; return 0; } struct fb_dev pl111_dev = { .init = &pl111_init_dev }; void pl111_init() { fb_register_device(&pl111_dev); } device_initcall(pl111_init);