diff options
Diffstat (limited to 'ANDROID_3.4.5/drivers/video/wmt/ge/ge_main.c')
| -rwxr-xr-x | ANDROID_3.4.5/drivers/video/wmt/ge/ge_main.c | 795 |
1 files changed, 0 insertions, 795 deletions
diff --git a/ANDROID_3.4.5/drivers/video/wmt/ge/ge_main.c b/ANDROID_3.4.5/drivers/video/wmt/ge/ge_main.c deleted file mode 100755 index 4b362fe3..00000000 --- a/ANDROID_3.4.5/drivers/video/wmt/ge/ge_main.c +++ /dev/null @@ -1,795 +0,0 @@ -/* - * Copyright (c) 2008-2013 WonderMedia Technologies, Inc. - * - * 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, see <http://www.gnu.org/licenses/>. - * - * WonderMedia Technologies, Inc. - * 4F, 533, Chung-Cheng Road, Hsin-Tien, Taipei 231, R.O.C - */ - -#include <linux/init.h> -#include <linux/module.h> -#include <linux/types.h> -#include <linux/fs.h> -#include <linux/kernel.h> -#include <linux/platform_device.h> -#include <linux/errno.h> -#include <linux/uaccess.h> -#include <linux/kdev_t.h> -#include <linux/cdev.h> -#include <linux/fb.h> -#include <linux/dma-mapping.h> -#include <asm/page.h> -#include <linux/mm.h> -#include <linux/sched.h> - -#include "ge_accel.h" - -#define HAVE_MALI -#define WMT_MB - -#ifdef HAVE_MALI -#include "../mali.h" -static struct mali_device *malidev; -#define UMP_INVALID_SECURE_ID ((unsigned int)-1) -#define GET_UMP_SECURE_ID _IOWR('m', 310, unsigned int) -#define GET_UMP_SECURE_ID_BUF1 _IOWR('m', 311, unsigned int) -#define GET_UMP_SECURE_ID_BUF2 _IOWR('m', 312, unsigned int) -#define MALI_GET_UMP_SECURE_ID _IOWR('m', 320, unsigned int) -#define MALI_PUT_UMP_SECURE_ID _IOWR('m', 321, unsigned int) -#endif /* HAVE_MALI */ - -#ifndef FBIO_WAITFORVSYNC -#define FBIO_WAITFORVSYNC _IOW('F', 0x20, u_int32_t) -#endif - -#define GEIO_MAGIC 0x69 - -#ifdef GEIO_MAGIC -#define GEIOGET_CHIP_ID _IOR(GEIO_MAGIC, 5, unsigned int) -#endif - -static int vtotal = 32; -static int mbsize; - -module_param(vtotal, int, S_IRUSR | S_IWUSR | S_IWGRP | S_IRGRP | S_IROTH); -MODULE_PARM_DESC(vtotal, "Maximum GE memory size in MiB"); - -module_param(mbsize, int, S_IRUSR | S_IWUSR | S_IWGRP | S_IRGRP | S_IROTH); -MODULE_PARM_DESC(mbsize, "WMT-MB size in MiB"); - -static struct fb_fix_screeninfo gefb_fix = { - .id = "gefb", - .smem_start = 0, - .smem_len = 0, - .type = FB_TYPE_PACKED_PIXELS, - .type_aux = 0, - .visual = FB_VISUAL_TRUECOLOR, - .xpanstep = 1, - .ypanstep = 1, - .ywrapstep = 1, - .line_length = 0, -#ifdef HAVE_MALI - .mmio_start = 0xd8080000, - .mmio_len = 0x10000, -#else - .mmio_start = 0, - .mmio_len = 0, -#endif - .accel = FB_ACCEL_WMT -}; - -static struct fb_var_screeninfo gefb_var = { - .xres = CONFIG_DEFAULT_RESX, - .yres = CONFIG_DEFAULT_RESY, - .xres_virtual = CONFIG_DEFAULT_RESX, - .yres_virtual = CONFIG_DEFAULT_RESY, - /* - .bits_per_pixel = 32, - .red = {16, 8, 0}, - .green = {8, 8, 0}, - .blue = {0, 8, 0}, - .transp = {0, 0, 0}, - */ - .bits_per_pixel = 16, - .red = {11, 5, 0}, - .green = {5, 6, 0}, - .blue = {0, 5, 0}, - .transp = {0, 0, 0}, - .activate = FB_ACTIVATE_NOW | FB_ACTIVATE_FORCE, - .height = -1, - .width = -1, - .pixclock = 39721, - .left_margin = 40, - .right_margin = 24, - .upper_margin = 32, - .lower_margin = 11, - .hsync_len = 96, - .vsync_len = 2, - .vmode = FB_VMODE_NONINTERLACED -}; - -static int gefb_open(struct fb_info *info, int user) -{ - return 0; -} - -static int gefb_release(struct fb_info *info, int user) -{ - return ge_release(info); -} - -static int gefb_check_var(struct fb_var_screeninfo *var, - struct fb_info *info) -{ -#ifdef HAVE_VPP - return wmtfb_check_var(var, info); -#else - switch (var->bits_per_pixel) { - case 1: - case 8: - if (var->red.offset > 8) { - /* LUT8 */ - var->red.offset = 0; - var->red.length = 8; - var->green.offset = 0; - var->green.length = 8; - var->blue.offset = 0; - var->blue.length = 8; - var->transp.offset = 0; - var->transp.length = 0; - } - break; - case 16: - if (var->transp.length) { - /* ARGB 1555 */ - var->red.offset = 10; - var->red.length = 5; - var->green.offset = 5; - var->green.length = 5; - var->blue.offset = 0; - var->blue.length = 5; - var->transp.offset = 15; - var->transp.length = 1; - } else { - /* RGB 565 */ - var->red.offset = 11; - var->red.length = 5; - var->green.offset = 5; - var->green.length = 6; - var->blue.offset = 0; - var->blue.length = 5; - var->transp.offset = 0; - var->transp.length = 0; - } - break; - case 24: - /* RGB 888 */ - var->red.offset = 16; - var->red.length = 8; - var->green.offset = 8; - var->green.length = 8; - var->blue.offset = 0; - var->blue.length = 8; - var->transp.offset = 0; - var->transp.length = 0; - break; - case 32: - /* ARGB 8888 */ - var->red.offset = 16; - var->red.length = 8; - var->green.offset = 8; - var->green.length = 8; - var->blue.offset = 0; - var->blue.length = 8; - var->transp.offset = 0; - var->transp.length = 0; - break; - } - return 0; -#endif -} - -static int gefb_set_par(struct fb_info *info) -{ - struct fb_var_screeninfo *var = &info->var; - - /* init your hardware here */ - if (var->bits_per_pixel == 8) - info->fix.visual = FB_VISUAL_PSEUDOCOLOR; - else - info->fix.visual = FB_VISUAL_TRUECOLOR; - - if (ge_init(info)) - return -ENOMEM; - -#ifdef HAVE_VPP - vpp_set_par(info); -#endif - - info->fix.line_length = var->xres_virtual * var->bits_per_pixel / 8; - - return 0; -} - -static int gefb_setcolreg(unsigned regno, unsigned red, - unsigned green, unsigned blue, - unsigned transp, struct fb_info *info) -{ - if (regno >= 256) /* no. of hw registers */ - return -EINVAL; - - /* grayscale */ - - if (info->var.grayscale) { - /* grayscale = 0.30*R + 0.59*G + 0.11*B */ - red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8; - } - - /* The following is for fbcon. */ - - if (info->fix.visual == FB_VISUAL_TRUECOLOR || - info->fix.visual == FB_VISUAL_DIRECTCOLOR) { - - if (regno >= 16) - return -EINVAL; - - switch (info->var.bits_per_pixel) { - case 16: - ((unsigned int *)(info->pseudo_palette))[regno] = - (red & 0xf800) | - ((green & 0xfc00) >> 5) | - ((blue & 0xf800) >> 11); - break; - case 24: - case 32: - red >>= 8; - green >>= 8; - blue >>= 8; - ((unsigned int *)(info->pseudo_palette))[regno] = - (red << info->var.red.offset) | - (green << info->var.green.offset) | - (blue << info->var.blue.offset); - break; - } - } - return 0; -} - -static int gefb_ioctl(struct fb_info *info, unsigned int cmd, - unsigned long arg) -{ - int retval = 0; - - switch (cmd) { - case FBIO_WAITFORVSYNC: - ge_vo_wait_vsync(); - break; -#ifdef HAVE_MALI - case GET_UMP_SECURE_ID: - case GET_UMP_SECURE_ID_BUF1: - case GET_UMP_SECURE_ID_BUF2: { - unsigned int ump_id; - if (mali_get_ump_secure_id) - ump_id = (*mali_get_ump_secure_id)(info->fix.smem_start, - info->fix.smem_len); - else - ump_id = UMP_INVALID_SECURE_ID; - return put_user((unsigned int) ump_id, - (unsigned int __user *) arg); - } - case MALI_GET_UMP_SECURE_ID: { - unsigned int args[3]; - unsigned int ump_id; - copy_from_user(args, (void *)arg, sizeof(unsigned int) * 3); - - if (mali_get_ump_secure_id) - ump_id = (*mali_get_ump_secure_id)(args[0], args[1]); - else - ump_id = UMP_INVALID_SECURE_ID; - - return put_user((unsigned int) ump_id, - (unsigned int __user *) args[2]); - } - case MALI_PUT_UMP_SECURE_ID: { - unsigned int ump_id = (unsigned int)arg; - if (mali_put_ump_secure_id) - (*mali_put_ump_secure_id)(ump_id); - break; - } -#endif /* HAVE_MALI */ -#ifdef GEIO_MAGIC - case GEIOGET_CHIP_ID: { - unsigned int chip_id = - (*(unsigned int *)SYSTEM_CFG_CTRL_BASE_ADDR); - copy_to_user((void *)arg, (void *)&chip_id, - sizeof(unsigned int)); - break; - } -#endif /* GEIO_MAGIC */ - default: - break; - } - - return retval; -} - -int gefb_hw_cursor(struct fb_info *info, struct fb_cursor *cursor) -{ - return 0; -} - -static int gefb_mmap(struct fb_info *info, struct vm_area_struct *vma) -{ - unsigned long off; - unsigned long start; - u32 len; - int ismmio = 0; - - if (!info) - return -ENODEV; - if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT)) - return -EINVAL; - off = vma->vm_pgoff << PAGE_SHIFT; - - /* frame buffer memory */ - start = info->fix.smem_start; - len = PAGE_ALIGN((start & ~PAGE_MASK) + info->fix.smem_len); - if (off >= len) { - /* memory mapped io */ - off -= len; - /* - if (info->var.accel_flags) { - return -EINVAL; - } - */ - start = info->fix.mmio_start; - len = PAGE_ALIGN((start & ~PAGE_MASK) + info->fix.mmio_len); - ismmio = 1; - } - start &= PAGE_MASK; - if ((vma->vm_end - vma->vm_start + off) > len) - return -EINVAL; - off += start; - vma->vm_pgoff = off >> PAGE_SHIFT; - /* This is an IO map - tell maydump to skip this VMA */ - vma->vm_flags |= VM_IO | VM_RESERVED; - vma->vm_page_prot = vm_get_page_prot(vma->vm_flags); - - if (ismmio) - vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); - else - vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot); - - if (io_remap_pfn_range(vma, vma->vm_start, off >> PAGE_SHIFT, - vma->vm_end - vma->vm_start, vma->vm_page_prot)) - return -EAGAIN; - return 0; -} - -static struct fb_ops gefb_ops = { - .owner = THIS_MODULE, - .fb_open = gefb_open, - .fb_release = gefb_release, - .fb_check_var = gefb_check_var, - .fb_set_par = gefb_set_par, - .fb_setcolreg = gefb_setcolreg, - .fb_pan_display = ge_pan_display, - .fb_fillrect = cfb_fillrect, - .fb_copyarea = cfb_copyarea, - .fb_imageblit = cfb_imageblit, - .fb_blank = ge_blank, - .fb_cursor = gefb_hw_cursor, - .fb_ioctl = gefb_ioctl, - .fb_sync = ge_sync, - .fb_mmap = gefb_mmap, -}; - -#define OPT_EQUAL(opt, name) (!strncmp(opt, name, strlen(name))) -#define OPT_INTVAL(opt, name) kstrtoul(opt + strlen(name) + 1, 0, NULL) -#define OPT_STRVAL(opt, name) (opt + strlen(name)) - -static inline char *get_opt_string(const char *this_opt, const char *name) -{ - const char *p; - int i; - char *ret; - - p = OPT_STRVAL(this_opt, name); - i = 0; - while (p[i] && p[i] != ' ' && p[i] != ',') - i++; - ret = kmalloc(i + 1, GFP_KERNEL); - if (ret) { - strncpy(ret, p, i); - ret[i] = '\0'; - } - return ret; -} - -static inline int get_opt_int(const char *this_opt, const char *name, - int *ret) -{ - if (!ret) - return 0; - - if (!OPT_EQUAL(this_opt, name)) - return 0; - - *ret = OPT_INTVAL(this_opt, name); - - return 1; -} - -static inline int get_opt_bool(const char *this_opt, const char *name, - int *ret) -{ - if (!ret) - return 0; - - if (OPT_EQUAL(this_opt, name)) { - if (this_opt[strlen(name)] == '=') - *ret = kstrtoul(this_opt + strlen(name) + 1, 0, NULL); - else - *ret = 1; - } else { - if (OPT_EQUAL(this_opt, "no") && OPT_EQUAL(this_opt + 2, name)) - *ret = 0; - else - return 0; - } - return 1; -} - -static int __init gefb_setup(char *options) -{ - char *this_opt; - - if (!options || !*options) - return 0; - - /* The syntax is: - * video=gefb:[<param>][,<param>=<val>] ... - * e.g., - * video=gefb:vtotal=12, - */ - - while ((this_opt = strsep(&options, ",")) != NULL) { - if (!*this_opt) - continue; - if (get_opt_int(this_opt, "vtotal", &vtotal)) - ; - else if (get_opt_int(this_opt, "mbsize", &mbsize)) - ; - else if (get_opt_bool(this_opt, "vbl", &vbl)) - ; - else if (get_opt_bool(this_opt, "vsync", &vsync)) - ; - } - - return 0; -} - -#ifdef HAVE_MALI -static struct mali_device *add_mali_device(unsigned int *smem_start_ptr, - unsigned int *smem_len_ptr) -{ - unsigned int len; - struct mali_device *dev = create_mali_device(); - if (dev) { - dev->set_memory_base(*smem_start_ptr); - dev->get_memory_size(&len); - *smem_start_ptr += len; - *smem_len_ptr -= len; - dev->set_mem_validation_base(*smem_start_ptr); - dev->set_mem_validation_size(*smem_len_ptr); - } - return dev; -} -#endif /* HAVE_MALI */ - -#ifdef WMT_MB -static int get_mbsize(void) -{ - /* It is bad to read U-Boot partition directly. - * I will remove this code soon. - * -- Vincent - */ - unsigned char buf[32]; - int varlen = 32; - int val; - - if (wmt_getsyspara("mbsize", buf, &varlen) == 0) - sscanf(buf, "%dM", &val); - else - val = 0; - - return val; -} - -static void add_mb_device(unsigned int *smem_start_ptr, - unsigned int *smem_len_ptr) -{ - unsigned int len = mbsize << 20; - - if (*smem_len_ptr > len) - *smem_len_ptr -= len; -} -#endif /* WMT_MB */ - -static int __devinit gefb_probe(struct platform_device *dev) -{ - struct fb_info *info; - int cmap_len, retval; -/* char mode_option[] = "1024x768@60"; */ - unsigned int smem_start; - unsigned int smem_len; - unsigned int len; - unsigned int min_smem_len; - unsigned int id; - - /* Allocate fb_info and par.*/ - info = framebuffer_alloc(sizeof(unsigned int) * 16, &dev->dev); - if (!info) - return -ENOMEM; - - /* Set default fb_info */ - info->fbops = &gefb_ops; - info->fix = gefb_fix; - - info->var = gefb_var; - ge_vo_get_default_var(&info->var); - - smem_start = (num_physpages << PAGE_SHIFT); - smem_len = phy_mem_end() - smem_start; - - /* If newer than WM3498, reserve 1MiB for U-Boot env */ - id = (*(unsigned int *)SYSTEM_CFG_CTRL_BASE_ADDR) >> 16; - if (id > 0x3498) { - smem_start += 0x100000; - smem_len -= 0x100000; - } - -#ifdef HAVE_MALI - malidev = add_mali_device(&smem_start, &smem_len); -#endif /* HAVE_MALI */ - -#ifdef WMT_MB - add_mb_device(&smem_start, &smem_len); -#endif /* WMT_MB */ - - /* Set frame buffer region */ - - len = info->var.xres * info->var.yres * - (info->var.bits_per_pixel >> 3); - len *= GE_FB_NUM; - min_smem_len = (len + PAGE_MASK) & ~PAGE_MASK; - - if (smem_len < min_smem_len) { - printk(KERN_ERR "%s: claim region of 0x%08x-0x%08x failed!\n", - __func__, smem_start, smem_start + min_smem_len); - return -EIO; - } - - info->fix.smem_start = smem_start; - - if (smem_len > (vtotal << 20)) - smem_len = (vtotal << 20); - - info->fix.smem_len = smem_len; - - if (!request_mem_region(info->fix.smem_start, - info->fix.smem_len, "gefb")) { - printk(KERN_WARNING - "%s: request memory region failed at 0x%08lx\n", - __func__, info->fix.smem_start); - } - - info->screen_base = ioremap(info->fix.smem_start, - info->fix.smem_len); - if (!info->screen_base) { - printk(KERN_ERR "%s: ioremap fail %d bytes at %p\n", - __func__, info->fix.smem_len, - (void *)info->fix.smem_start); - return -EIO; - } - - printk(KERN_INFO - "gefb: phys 0x%08lx, virt 0x%08lx, total %d KB\n", - info->fix.smem_start, (unsigned long)info->screen_base, - info->fix.smem_len >> 10); - - /* - * The pseudopalette is an 16-member array for fbcon. - */ - info->pseudo_palette = info->par; - info->par = NULL; - info->flags = FBINFO_DEFAULT; /* flag for fbcon */ - -#if 0 - /* - * This should give a reasonable default video mode. - */ - retval = fb_find_mode(&info->var, info, mode_option, - NULL, 0, NULL, 8); - - if (!retval || retval == 4) - return -EINVAL; -#endif - /* - * This has to been done !!! - */ - cmap_len = 256; /* Be the same as VESA */ - retval = fb_alloc_cmap(&info->cmap, cmap_len, 0); - if (retval < 0) - printk(KERN_ERR "%s: fb_alloc_cmap fail.\n", __func__); - - /* - * The following is done in the case of - * having hardware with a static mode. - */ - info->var = gefb_var; - - /* - * Get setting from video output device. - */ - ge_vo_get_default_var(&info->var); - - /* - * For drivers that can... - */ - gefb_check_var(&info->var, info); - - /* - * Apply setting - */ - gefb_set_par(info); - ge_pan_display(&info->var, info); - - if (register_framebuffer(info) < 0) { - ge_exit(info); - return -EINVAL; - } - info->dev->power.async_suspend = 1; /* Add by Charles */ - dev_set_drvdata(&dev->dev, info); - - return 0; -} - -static int gefb_remove(struct platform_device *dev) -{ - struct fb_info *info = dev_get_drvdata(&dev->dev); - - if (info) { - ge_exit(info); - unregister_framebuffer(info); - fb_dealloc_cmap(&info->cmap); - framebuffer_release(info); - } - return 0; -} - -static int gefb_suspend(struct platform_device *dev, pm_message_t state) -{ - struct fb_info *info = dev_get_drvdata(&dev->dev); - - if (info) - ge_suspend(info); - -#ifdef HAVE_MALI - if (malidev) - malidev->suspend(1); -#endif - - return 0; -} - -static int gefb_resume(struct platform_device *dev) -{ - struct fb_info *info = dev_get_drvdata(&dev->dev); - - if (info) - ge_resume(info); - -#ifdef HAVE_MALI - if (malidev) - malidev->resume(1); -#endif - - return 0; -} - -static struct platform_driver gefb_driver = { - .driver.name = "gefb", - .probe = gefb_probe, - .remove = gefb_remove, - .suspend = gefb_suspend, - .resume = gefb_resume, -}; - -static u64 gefb_dma_mask = 0xffffffffUL; -static struct platform_device gefb_device = { - .name = "gefb", - .dev = { - .dma_mask = &gefb_dma_mask, - .coherent_dma_mask = ~0, - }, -}; - -#ifdef WMT_MB -static int __init mbsize_setup(char *options) -{ - char *this_opt; - - if (!options || !*options) - return 0; - - while ((this_opt = strsep(&options, ",")) != NULL) { - if (!*this_opt) - continue; - sscanf(this_opt, "%dM", &mbsize); - printk(KERN_DEBUG "gefb: detected mbsize = %d MiB\n", mbsize); - } - - return 0; -} -__setup("mbsize=", mbsize_setup); -#endif /* WMT_MB */ - -static int __init gefb_init(void) -{ - int ret; - char *option = NULL; - - fb_get_options("gefb", &option); - gefb_setup(option); - -#ifdef WMT_MB - /* It is bad to read U-Boot partition directly. - * I will remove this code soon. - * -- Vincent - */ - if (!mbsize) { - mbsize = get_mbsize(); - printk(KERN_ERR "Please add \'mbsize=%dM\' in bootargs!", - mbsize); - } -#endif /* WMT_MB */ - - ret = platform_driver_register(&gefb_driver); - if (!ret) { - ret = platform_device_register(&gefb_device); - if (ret) - platform_driver_unregister(&gefb_driver); - } - - return ret; -} -module_init(gefb_init); - -static void __exit gefb_exit(void) -{ - release_mali_device(malidev); - - platform_driver_unregister(&gefb_driver); - platform_device_unregister(&gefb_device); - return; -} - -module_exit(gefb_exit); - -MODULE_AUTHOR("WonderMedia Technologies, Inc."); -MODULE_DESCRIPTION("WMT GE driver"); -MODULE_LICENSE("GPL"); - |