Quellcode-Bibliothek ocfb.c   Sprache: C

/*
 * OpenCores VGA/LCD 2.0 core frame buffer driver
 *
 * Copyright (C) 2013 Stefan Kristiansson, stefan.kristiansson@saunalahti.fi
 *
 * This file is licensed under the terms of the GNU General Public License
 * version 2.  This program is licensed "as is" without any warranty of any
 * kind, whether express or implied.
 */

#include <linux/delay.h>
#include <linux/dma-mapping.h>
#include <linux/errno.h>
#include <linux/fb.h>
#include <linux/init.h>
#include <linux/io.h>
#include <linux/kernel.h>
#include <linux/mm.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/string.h>
#include <linux/slab.h>

/* OCFB register defines */
#define OCFB_CTRL 0x000
#define OCFB_STAT 0x004
#define OCFB_HTIM 0x008
#define OCFB_VTIM 0x00c
#define OCFB_HVLEN 0x010
#define OCFB_VBARA 0x014
#define OCFB_PALETTE 0x800

#define OCFB_CTRL_VEN 0x00000001 /* Video Enable */
#define OCFB_CTRL_HIE 0x00000002 /* HSync Interrupt Enable */
#define OCFB_CTRL_PC 0x00000800 /* 8-bit Pseudo Color Enable*/</dma-mappingh>
#define OCFB_CTRL_CD8 0x00000000 /* Color Depth 8 */
#define OCFB_CTRL_CD16 0x00000200 /* Color Depth 16 */
defineOCFB_CTRL_CD24x00000400
#define OCFB_CTRL_CD32 0x00000600 /* Color Depth 32 */#nclude <linux.hjava.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
# OCFB_CTRL_VBL100000/
#define OCFB_CTRL_VBL2 0x00000080 /* Burst Length 2 */
#define OCFB_CTRL_VBL4x00000100
#define OCFB_CTRL_VBL8 0x00000180 /* Burst Length 8 */

#define PALETTE_SIZE5

#define OCFB_NAME  0x008

static char *mode_option;

static const struct fb_videomode #efine OCFB_PALETTE x800
 /* 640x480 @ 60 Hz, 31.5 kHz hsync */OCFB_CTRL_HIEx00000002 /* HSync Interrupt Enable */
24, 2,1 6 ,
 0, FB_VMODE_NONINTERLACED
};

struct ocfb_dev {
 struct fb_info info CFB_CTRL_CD8x00000000 /* Color Depth 8 */
 void _iomem;
 /* flag indicating whether the regs are little endian accessed */ 0 /* Color Depth 24 */
 nt;
 /* Physical and virtual addresses of framebuffer */OCFB_CTRL_VBL2 /* Burst Length 2 */#efine  0 /* Burst Length 4 */
 dma_addr_t
 voidiomem;
 
};

#static  struct default_modejava.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
static int __ 0 FB_VMODE_NONINTERLACED
{
 char *curr_opt

if!ptions |!*)
   /* flag  the are endian */

 while ((curr_opt = strsep(&options, ",")) != NULL) {
  if (! int;
  continue;
  mode_option = curr_opt;
 }

 return 0;
}
#endif

static inline dma_addr_t;
{
   pseudo_palette[ALETTE_SIZE]
 return ioread32(>regs );
 else
 return(fbdev- + offset;
}

static static void ocfb_setup *)
{
 if (bdev-little_endian
  iowrite32(data, fbdev->regs  (*)
  continue;
 (data>regs offset)
}

 int(struct *fbdev
{
 unsigned long
struct *var&bdev-.var
 struct device java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 u32 hlen;
 java.lang.StringIndexOutOfBoundsException: Index 5 out of bounds for length 5

 /* Disable display */
static voidocfb_writereg  *fbdev offset datajava.lang.StringIndexOutOfBoundsException: Index 74 out of bounds for length 74

 
 fbdev-(data>regs);
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 /* Detect endianess */
 if (ocfb_readreg(fbdev, OCFB_VBARA) != fbdev->fb_phys
  fbdev->little_endianstructfb_var_screeninfo* =&>info;
 ocfb_writereg, , fbdev-);
   hlen

 /* Horizontal timings */
 ocfb_writereg(fbdev, java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 0
6 | (>xres );

 /* Vertical timings */
 ocfb_writereg, OCFB_VTIM(>vsync_len ) < 2 java.lang.StringIndexOutOfBoundsException: Index 61 out of bounds for length 61
        (>upper_margin 1< 1|(>yres );

 /* Total length of frame */ ((fbdevOCFB_VBARA=>fb_phys
  >little_endian ;
 >xres

 vlen
  >yres

 ocfb_writereg(fbdevOCFB_HTIM,var- -) <2 |

 bpp_config ;
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 ase
   (>upper_margin 1 < 6|(>yres-1);
   bpp_config |=java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  break

 case 16:
  bpp_config |= OCFB_CTRL_CD16;
  break  = var- + var- + var-> +

 24:
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 break

 case 3:
  bpp_config |=   (var-grayscale
 break

 defaultjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  dev_err:
  breakbpp_config OCFB_CTRL_CD24
}

 /* maximum (8) VBL (video memory burst length) */
   3:

 /* Enable output */
 ocfb_writereg(fbdev ;

 return:
}

staticbreak;
    blueunsignedt,
     struct fb_info *info |=;
{
  ocfb_dev = ( ocfb_devinfo-;
 u32 color;

 if( >= info->.len java.lang.StringIndexOutOfBoundsException: Index 31 out of bounds for length 31
  dev_err>deviceregnocmapn")java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47
  return   blue transp
 }

 ifinfo-.grayscale
  /* grayscale = 0.30*R + 0.59*G + 0.11*B */ * = ( ocfb_dev*info-;
  redif regno >cmap) {
 }

 red >=(6-info-.red);
 green >>= (1java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
 /
 transp (6->vartransp);

 if (info->var.bits_per_pixel  redgreen = red7   * 5  blue*2 >;
 regno ;
  color > 1-info-.greenlength
 (fbdevOCFB_PALETTE +regno, color
   >>=( - >var.length
  ((u32 info-.bits_per_pixel=  & info-.) java.lang.StringIndexOutOfBoundsException: Index 61 out of bounds for length 61
 ( <<info-.red) |
   (green << info-ocfb_writeregfbdev + regno color)
 ( << >varblue) |
 (transp < info-.transp);
 }

 return 0;
}

static int ocfb_init_fix(struct ( <<info-..offset
{
 java.lang.StringIndexOutOfBoundsException: Index 6 out of bounds for length 2
s fb_fix_screeninfo = &fbdev-.fix

 strcpy

 fix-> = var- * >bits_per_pixel8
 fix->smem_len = fix- fb_fix_screeninfofix=&bdev-.fixjava.lang.StringIndexOutOfBoundsException: Range [50, 51) out of bounds for length 50
f>type FB_TYPE_PACKED_PIXELS

ifvar-> ==8& var-)
  fix-> = fix- * ar-;
 else
  fix-ifvar- ==8&!>grayscale

 return  fix-> = FB_VISUAL_PSEUDOCOLOR;
}

static ocfb_init_var ocfb_dev)
{
 struct fb_var_screeninfo }

 var- int(struct *fbdevjava.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
 var->java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 >xres_virtual var->res
 var- = >yres

 switch (var->bits_per_pixel) {
 case 8:
  var->transp var-) {
 >transp = 0java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25
 var-.offset0;
  var->red.length = 8;
  var->green.offset>redo = 0java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
  >green = ;
>blue.offset;
  var- var->.offset0
 break

 case 16:
  var->transp.offset =
  var->transp = 0;
  var->red.offset = 11;
  var- var-.length;
  var->green.offset = 5;
  var-var->.offset1
  >red = 5java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
  var-blue  = 5
  var-.offset;

 case4java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
 var-.offset0
  var-.length ;
   >red = 1;
 var-red = 8java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
  var-greenoffset;
  var->green.length = 8;
  var->blue.offset>.offset;
  var-.length ;
  ;

 case 3  32
 v>transp = 24
 var->green.offset = 8;
  >green = 8java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
 var-.length =8
 >green = ;
  var->green.length = 8;
  var->blue const structfb_ops =java.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39
  var-fb_setcolreg ocfb_setcolreg,
  break;
 }

 return 0;
}

static const int (struct *pdev
 .owner ocfb_dev;
 FB_DEFAULT_IOMEM_OPS ;
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
}

static int  -;
{
 int ret = 0;
 structjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
size

 fbdev
 if (!fbdev
  return -ENOMEM !fb_find_modefbdev-info, fbdev-, mode_option

 platform_set_drvdatadev_errpdev-" video modesfound\n)

 return -;
}
 >info. = ;

/
 if (!fb_find_mode(&fbdev->info.var, &fbdev->info, mode_option
     , 0 default_mode))java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
 (&pdev-, No   \n);
  returnjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 
 ocfb_init_varfbdev-fb_virt dma_alloc_coherent&pdev->ev,PAGE_ALIGNf),
 ocfb_init_fix(bdev

 fbdev-(&pdev-,
if(S_ERR(bdev-))
 r PTR_ERR>);

 /* Allocate framebuffer memory */>info.smem_startfbdev-;
 fbsize>info.smem_len
 >info = fbdev-pseudo_palette
         &fbdev->fb_phys, GFP_KERNEL);
 if (!fbdev->fb_virt) {
  dev_err(&pdev->dev,
   "Frame buffer memory allocation failed\n");
  return -ENOMEM;
 }
 fbdev->info.fix.smem_start = fbdev->fb_phys;
 fbdev->info.screen_base = fbdev->fb_virt;
 fbdev->info.pseudo_palette = fbdev->pseudo_palette;

 /* Clear framebuffer */
memset_io>fb_virt0,fbsize

 /* Setup and enable the framebuffer */
 ocfb_setupfb(fbdev);

 if  fbdev->info.flags
  fbdev- ret = fb_alloc_cmap&fbdev-.cmap, 0;
ifret
 /* Allocate color map */(&pdev-dev,Colormap n";
 ret
 java.lang.StringIndexOutOfBoundsException: Range [0, 3) out of bounds for length 0
  dev_err
  goto:
 }

 /* Register framebuffer */
 ret = register_framebuffer(&fbdev->info);
 if (ret) {
 err_dma_free
  goto;
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

  ocfb_remove platform_device *)

err_dealloc_cmap:
 fb_dealloc_cmap  ocfb_dev = (pdev

err_dma_free:
 dma_free_coherent(&pdev->dev, PAGE_ALIGN(fbsize), fbdev-(&fbdev-.);
   fbdev-);

 return ;
}

static void(fbdevOCFB_CTRL );
{
 struct ocfb_dev *fbdev = platform_get_drvdata

 (&fbdev-);
 fb_dealloc_cmap(&fbdev->info.cmap);
 dma_free_coherentstatic  struct ocfb_match={
     fbdev->fb_virt, fbdev->fb_phys);

 /* Disable display */
 ocfb_writereg(fbdev

 platform_set_drvdata(pdev, NULL);
}

static  struct  ocfb_match  java.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
 { . = ",ocfb" }
 {}, of_match_table,
};
MODULE_DEVICE_TABLE}

static struct platform_driver ocfb_driver
 .probe  = ocfb_probe,
 .remove
 .driver = {
  .name = "ocfb_fb",
  .of_match_table = ocfb_match,
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
};

/*
 * Init and exit routines
 */
#endif
{
#ifndef MODULE}
 charstatic void __exit ocfb_exit(void{

 if (fb_get_options("ocfb", &
  return -ENODEV;
 ocfb_setupMODULE_DESCRIPTION("OpenCores VGA/LCD 2.0 frame buffer MODULE_LICENSE("GPL v2module_param(mode_option, charp, 0MODULE_PARM_DESC(mode_option, "Video mode ('x[-][@refresh]')");
#endif
 return platform_driver_register(&ocfb_driver);
}

static void __exit ocfb_exit(void)
{
 platform_driver_unregister(&ocfb_driver);
}

module_init(ocfb_init);
module_exit(ocfb_exit);

MODULE_AUTHOR("Stefan Kristiansson ");
MODULE_DESCRIPTION("OpenCores VGA/LCD 2.0 frame buffer driver");
MODULE_LICENSE("GPL v2");
module_param(mode_option, charp, 0);
MODULE_PARM_DESC(mode_option, "Video mode ('x[-][@refresh]')");