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
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
|
/* Framebuffer implementation - Toppoly TD014 LCD driver for Motorola C139/40 */
/* Based on td014.c by Steve Markgraf and Harald Welte */
/* (C) 2010 by Christian Vogel <vogelchr@vogel.cx>
* (C) 2012 by Steve Markgraf <steve@steve-m.de>
*
* All Rights Reserved
*
* 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.
*
*/
#include <fb/framebuffer.h>
#include <fb/fb_rgb332.h>
#include <stdint.h>
#include <stdio.h>
#include <delay.h>
#include <uwire.h>
#include <calypso/clock.h>
#define TD014_WIDTH 96
#define TD014_HEIGHT 64
#define TD014_UWIRE_BITLEN 9
#define TD014_DEV_ID 0
static uint8_t fb_td014_mem[TD014_WIDTH * TD014_HEIGHT];
enum td014_cmdflag { CMD, DATA, END };
struct td014_cmdlist {
enum td014_cmdflag is_cmd:8; /* 1: is a command, 0: is data, 2: end marker! */
uint8_t data; /* 8 bit to send to LC display */
} __attribute__((packed));
static const struct td014_cmdlist
td014_initdata[] = {
{ CMD, 0x3f },
{ DATA, 0x01 },
{ CMD, 0x20 },
{ DATA, 0x03 },
{ CMD, 0x31 },
{ DATA, 0x03 },
{ END, 0x00 }, /* MARKER: end of list */
};
static void
fb_td014_send_cmdlist(const struct td014_cmdlist *p) {
int i=0;
while(p->is_cmd != END){
uint16_t sendcmd = p->data;
if(p->is_cmd == DATA)
sendcmd |= 0x0100; /* 9th bit is cmd/data flag */
uwire_xfer(TD014_DEV_ID, TD014_UWIRE_BITLEN, &sendcmd, NULL);
p++;
i++;
}
}
static void
fb_td014_init(void) {
printf("%s: initializing LCD.\n",__FUNCTION__);
calypso_reset_set(RESET_EXT, 0);
delay_ms(5);
uwire_init();
delay_ms(5);
fb_td014_send_cmdlist(td014_initdata);
}
static void
fb_td014_flush(void) {
int x,y;
uint8_t *p;
struct td014_cmdlist prepare_disp_write_cmds[] = {
{ CMD, 0x10 },
{ DATA, fb_rgb332->damage_x1 },
{ CMD, 0x11 },
{ DATA, fb_rgb332->damage_y1 },
{ CMD, 0x12 },
{ DATA, fb_rgb332->damage_x2-1 },
{ CMD, 0x13 },
{ DATA, fb_rgb332->damage_y2-1 },
{ CMD, 0x14 },
{ DATA, fb_rgb332->damage_x1 },
{ CMD, 0x15 },
{ DATA, fb_rgb332->damage_y1 },
{ END, 0x00 }
};
/* If everything's clean, just return */
if(fb_rgb332->damage_x1 == fb_rgb332->damage_x2 ||
fb_rgb332->damage_y1 == fb_rgb332->damage_y2) {
printf("%s: no damage\n",__FUNCTION__);
return;
}
fb_td014_send_cmdlist(prepare_disp_write_cmds);
for(y=fb_rgb332->damage_y1;y<fb_rgb332->damage_y2;y++) {
p = & fb_rgb332->mem[y * framebuffer->width]; // start of line
p += fb_rgb332->damage_x1; // start of damage area
for(x=fb_rgb332->damage_x1; x<fb_rgb332->damage_x2; x++) {
uint16_t pixel = rgb332_to_565(*p++);
uint16_t data = 0x0100 | (pixel >> 8);
uwire_xfer(TD014_DEV_ID, TD014_UWIRE_BITLEN,
&data, NULL);
data = 0x0100 | (pixel & 0xff);
uwire_xfer(TD014_DEV_ID, TD014_UWIRE_BITLEN,
&data, NULL);
}
}
fb_rgb332->damage_x1 = fb_rgb332->damage_x2 = 0;
fb_rgb332->damage_y1 = fb_rgb332->damage_y2 = 0;
}
static struct framebuffer fb_td014_framebuffer = {
.name = "td014",
.init = fb_td014_init,
.clear = fb_rgb332_clear,
.boxto = fb_rgb332_boxto,
.lineto = fb_rgb332_lineto,
.putstr = fb_rgb332_putstr,
.flush = fb_td014_flush,
.width = TD014_WIDTH,
.height = TD014_HEIGHT
};
static struct fb_rgb332 fb_td014_rgb332 = {
.mem = fb_td014_mem
};
struct framebuffer *framebuffer = &fb_td014_framebuffer;
struct fb_rgb332 *fb_rgb332 = &fb_td014_rgb332;
|
