hc
2023-11-23 7d07b3ae8ddad407913c5301877e694430a3263f
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
/*
 *    linux/arch/arm/mach-nspire/clcd.c
 *
 *    Copyright (C) 2013 Daniel Tang <tangrs@tangrs.id.au>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2, as
 * published by the Free Software Foundation.
 *
 */
 
#include <linux/init.h>
#include <linux/of.h>
#include <linux/amba/bus.h>
#include <linux/amba/clcd.h>
#include <linux/dma-mapping.h>
 
static struct clcd_panel nspire_cx_lcd_panel = {
   .mode        = {
       .name        = "Color LCD",
       .refresh    = 60,
       .xres        = 320,
       .yres        = 240,
       .sync        = 0,
       .vmode        = FB_VMODE_NONINTERLACED,
       .pixclock    = 1,
       .hsync_len    = 6,
       .vsync_len    = 1,
       .right_margin    = 50,
       .left_margin    = 38,
       .lower_margin    = 3,
       .upper_margin    = 17,
   },
   .width        = 65, /* ~6.50 cm */
   .height        = 49, /* ~4.87 cm */
   .tim2        = TIM2_IPC,
   .cntl        = CNTL_LCDTFT | CNTL_LCDVCOMP(1),
   .bpp        = 16,
   .caps        = CLCD_CAP_565,
};
 
static struct clcd_panel nspire_classic_lcd_panel = {
   .mode        = {
       .name        = "Grayscale LCD",
       .refresh    = 60,
       .xres        = 320,
       .yres        = 240,
       .sync        = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
       .vmode        = FB_VMODE_NONINTERLACED,
       .pixclock    = 1,
       .hsync_len    = 6,
       .vsync_len    = 1,
       .right_margin    = 6,
       .left_margin    = 6,
   },
   .width        = 71, /* 7.11cm */
   .height        = 53, /* 5.33cm */
   .tim2        = 0x80007d0,
   .cntl        = CNTL_LCDMONO8,
   .bpp        = 8,
   .grayscale    = 1,
   .caps        = CLCD_CAP_5551,
};
 
int nspire_clcd_setup(struct clcd_fb *fb)
{
   struct clcd_panel *panel;
   size_t panel_size;
   const char *type;
   dma_addr_t dma;
   int err;
 
   BUG_ON(!fb->dev->dev.of_node);
 
   err = of_property_read_string(fb->dev->dev.of_node, "lcd-type", &type);
   if (err) {
       pr_err("CLCD: Could not find lcd-type property\n");
       return err;
   }
 
   if (!strcmp(type, "cx")) {
       panel = &nspire_cx_lcd_panel;
   } else if (!strcmp(type, "classic")) {
       panel = &nspire_classic_lcd_panel;
   } else {
       pr_err("CLCD: Unknown lcd-type %s\n", type);
       return -EINVAL;
   }
 
   panel_size = ((panel->mode.xres * panel->mode.yres) * panel->bpp) / 8;
   panel_size = ALIGN(panel_size, PAGE_SIZE);
 
   fb->fb.screen_base = dma_alloc_wc(&fb->dev->dev, panel_size, &dma,
                     GFP_KERNEL);
 
   if (!fb->fb.screen_base) {
       pr_err("CLCD: unable to map framebuffer\n");
       return -ENOMEM;
   }
 
   fb->fb.fix.smem_start = dma;
   fb->fb.fix.smem_len = panel_size;
   fb->panel = panel;
 
   return 0;
}
 
int nspire_clcd_mmap(struct clcd_fb *fb, struct vm_area_struct *vma)
{
   return dma_mmap_wc(&fb->dev->dev, vma, fb->fb.screen_base,
              fb->fb.fix.smem_start, fb->fb.fix.smem_len);
}
 
void nspire_clcd_remove(struct clcd_fb *fb)
{
   dma_free_wc(&fb->dev->dev, fb->fb.fix.smem_len, fb->fb.screen_base,
           fb->fb.fix.smem_start);
}