drivers/video/rockchip/screen/rk_screen.c

   1
   2 #include <linux/rk_fb.h>
   3 #include <linux/device.h>
   4 #include "lcd.h"
   5 #include "../hdmi/rockchip-hdmi.h"
   6
   7 static struct rk_screen *rk_screen;
   8 int  rk_fb_get_prmry_screen(struct rk_screen *screen)
   9 {
  10         if (unlikely(!rk_screen) || unlikely(!screen))
  11                 return -1;
  12
  13         memcpy(screen, rk_screen, sizeof(struct rk_screen));
  14         return 0;
  15 }
  16
  17 int rk_fb_set_prmry_screen(struct rk_screen *screen)
  18 {
  19         if (unlikely(!rk_screen) || unlikely(!screen))
  20                 return -1;
  21
  22         rk_screen->lcdc_id = screen->lcdc_id;
  23         rk_screen->screen_id = screen->screen_id;
  24         rk_screen->x_mirror = screen->x_mirror;
  25         rk_screen->y_mirror = screen->y_mirror;
  26         rk_screen->overscan.left = screen->overscan.left;
  27         rk_screen->overscan.top = screen->overscan.left;
  28         rk_screen->overscan.right = screen->overscan.left;
  29         rk_screen->overscan.bottom = screen->overscan.left;
  30         return 0;
  31 }
  32
  33 size_t get_fb_size(void)
  34 {
  35         size_t size = 0;
  36         u32 xres = 0;
  37         u32 yres = 0;
  38
  39         if (unlikely(!rk_screen))
  40                 return 0;
  41
  42         xres = rk_screen->mode.xres;
  43         yres = rk_screen->mode.yres;
  44
  45         /* align as 64 bytes(16*4) in an odd number of times */
  46         xres = ALIGN_64BYTE_ODD_TIMES(xres, ALIGN_PIXEL_64BYTE_RGB8888);
  47
  48         #if defined(CONFIG_THREE_FB_BUFFER)
  49                 size = (xres * yres << 2) * 3;  /* three buffer */
  50         #else
  51                 size = (xres * yres << 2) << 1; /* two buffer */
  52         #endif
  53         return ALIGN(size, SZ_1M);
  54 }
  55
  56 static int rk_screen_probe(struct platform_device *pdev)
  57 {
  58         struct device_node *np = pdev->dev.of_node;
  59         int ret;
  60
  61         if (!np) {
  62                 dev_err(&pdev->dev, "Missing device tree node.\n");
  63                 return -EINVAL;
  64         }
  65         rk_screen = devm_kzalloc(&pdev->dev,
  66                         sizeof(struct rk_screen), GFP_KERNEL);
  67         if (!rk_screen) {
  68                 dev_err(&pdev->dev, "kmalloc for rk screen fail!");
  69                 return  -ENOMEM;
  70         }
  71         ret = rk_fb_prase_timing_dt(np, rk_screen);
  72         dev_info(&pdev->dev, "rockchip screen probe %s\n",
  73                                 ret ? "failed" : "success");
  74         return ret;
  75 }
  76
  77 static const struct of_device_id rk_screen_dt_ids[] = {
  78         { .compatible = "rockchip,screen", },
  79         {}
  80 };
  81
  82 static struct platform_driver rk_screen_driver = {
  83         .probe          = rk_screen_probe,
  84         .driver         = {
  85                 .name   = "rk-screen",
  86                 .owner  = THIS_MODULE,
  87                 .of_match_table = of_match_ptr(rk_screen_dt_ids),
  88         },
  89 };
  90
  91 static int __init rk_screen_init(void)
  92 {
  93         return platform_driver_register(&rk_screen_driver);
  94 }
  95
  96 static void __exit rk_screen_exit(void)
  97 {
  98         platform_driver_unregister(&rk_screen_driver);
  99 }
 100
 101 fs_initcall(rk_screen_init);
 102 module_exit(rk_screen_exit);
 103