]>
Commit | Line | Data |
---|---|---|
39e7df5d GKH |
1 | #ifndef UDLFB_H |
2 | #define UDLFB_H | |
88e58b1a | 3 | |
39e7df5d GKH |
4 | #define MAX_VMODES 4 |
5 | #define FB_BPP 16 | |
88e58b1a | 6 | |
39e7df5d GKH |
7 | #define STD_CHANNEL "\x57\xCD\xDC\xA7\x1C\x88\x5E\x15" \ |
8 | "\x60\xFE\xC6\x97\x16\x3D\x47\xF2" | |
9 | ||
10 | /* as libdlo */ | |
11 | #define BUF_HIGH_WATER_MARK 1024 | |
12 | #define BUF_SIZE (64*1024) | |
88e58b1a RDI |
13 | |
14 | struct dlfb_data { | |
15 | struct usb_device *udev; | |
16 | struct usb_interface *interface; | |
17 | struct urb *tx_urb, *ctrl_urb; | |
18 | struct usb_ctrlrequest dr; | |
19 | struct fb_info *info; | |
20 | char *buf; | |
21 | char *bufend; | |
22 | char *backing_buffer; | |
23 | struct mutex bulk_mutex; | |
24 | char edid[128]; | |
25 | int screen_size; | |
26 | int line_length; | |
27 | struct completion done; | |
28 | int base16; | |
7316bc55 | 29 | int base16d; |
88e58b1a | 30 | int base8; |
7316bc55 | 31 | int base8d; |
88e58b1a RDI |
32 | }; |
33 | ||
34 | struct dlfb_video_mode { | |
88e58b1a RDI |
35 | uint8_t col; |
36 | uint32_t hclock; | |
37 | uint32_t vclock; | |
38 | uint8_t unknown1[6]; | |
39 | uint16_t xres; | |
40 | uint8_t unknown2[6]; | |
41 | uint16_t yres; | |
42 | uint8_t unknown3[4]; | |
88e58b1a RDI |
43 | } __attribute__ ((__packed__)); |
44 | ||
4b6a4856 | 45 | static struct dlfb_video_mode dlfb_video_modes[MAX_VMODES]; |
88e58b1a RDI |
46 | |
47 | static void dlfb_bulk_callback(struct urb *urb) | |
48 | { | |
88e58b1a RDI |
49 | struct dlfb_data *dev_info = urb->context; |
50 | complete(&dev_info->done); | |
88e58b1a RDI |
51 | } |
52 | ||
7316bc55 RDI |
53 | static void dlfb_edid(struct dlfb_data *dev_info) |
54 | { | |
55 | int i; | |
56 | int ret; | |
57 | char rbuf[2]; | |
58 | ||
59 | for (i = 0; i < 128; i++) { | |
60 | ret = | |
61 | usb_control_msg(dev_info->udev, | |
62 | usb_rcvctrlpipe(dev_info->udev, 0), (0x02), | |
63 | (0x80 | (0x02 << 5)), i << 8, 0xA1, rbuf, 2, | |
64 | 0); | |
65 | /*printk("ret control msg edid %d: %d [%d]\n",i, ret, rbuf[1]); */ | |
66 | dev_info->edid[i] = rbuf[1]; | |
67 | } | |
68 | ||
69 | } | |
70 | ||
88e58b1a RDI |
71 | static int dlfb_bulk_msg(struct dlfb_data *dev_info, int len) |
72 | { | |
88e58b1a RDI |
73 | int ret; |
74 | ||
75 | init_completion(&dev_info->done); | |
76 | ||
77 | dev_info->tx_urb->actual_length = 0; | |
78 | dev_info->tx_urb->transfer_buffer_length = len; | |
79 | ||
80 | ret = usb_submit_urb(dev_info->tx_urb, GFP_KERNEL); | |
81 | if (!wait_for_completion_timeout(&dev_info->done, 1000)) { | |
82 | usb_kill_urb(dev_info->tx_urb); | |
83 | printk("usb timeout !!!\n"); | |
84 | } | |
85 | ||
86 | return dev_info->tx_urb->actual_length; | |
88e58b1a RDI |
87 | } |
88 | ||
4b6a4856 | 89 | static void dlfb_init_modes(void) |
88e58b1a | 90 | { |
88e58b1a RDI |
91 | dlfb_video_modes[0].col = 0; |
92 | memcpy(&dlfb_video_modes[0].hclock, "\x20\x3C\x7A\xC9", 4); | |
93 | memcpy(&dlfb_video_modes[0].vclock, "\xF2\x6C\x48\xF9", 4); | |
94 | memcpy(&dlfb_video_modes[0].unknown1, "\x70\x53\xFF\xFF\x21\x27", 6); | |
95 | dlfb_video_modes[0].xres = 800; | |
96 | memcpy(&dlfb_video_modes[0].unknown2, "\x91\xF3\xFF\xFF\xFF\xF9", 6); | |
97 | dlfb_video_modes[0].yres = 480; | |
98 | memcpy(&dlfb_video_modes[0].unknown3, "\x01\x02\xC8\x19", 4); | |
99 | ||
100 | dlfb_video_modes[1].col = 0; | |
101 | memcpy(&dlfb_video_modes[1].hclock, "\x36\x18\xD5\x10", 4); | |
102 | memcpy(&dlfb_video_modes[1].vclock, "\x60\xA9\x7B\x33", 4); | |
103 | memcpy(&dlfb_video_modes[1].unknown1, "\xA1\x2B\x27\x32\xFF\xFF", 6); | |
104 | dlfb_video_modes[1].xres = 1024; | |
105 | memcpy(&dlfb_video_modes[1].unknown2, "\xD9\x9A\xFF\xCA\xFF\xFF", 6); | |
106 | dlfb_video_modes[1].yres = 768; | |
107 | memcpy(&dlfb_video_modes[1].unknown3, "\x04\x03\xC8\x32", 4); | |
108 | ||
109 | dlfb_video_modes[2].col = 0; | |
110 | memcpy(&dlfb_video_modes[2].hclock, "\x98\xF8\x0D\x57", 4); | |
111 | memcpy(&dlfb_video_modes[2].vclock, "\x2A\x55\x4D\x54", 4); | |
112 | memcpy(&dlfb_video_modes[2].unknown1, "\xCA\x0D\xFF\xFF\x94\x43", 6); | |
113 | dlfb_video_modes[2].xres = 1280; | |
114 | memcpy(&dlfb_video_modes[2].unknown2, "\x9A\xA8\xFF\xFF\xFF\xF9", 6); | |
115 | dlfb_video_modes[2].yres = 1024; | |
116 | memcpy(&dlfb_video_modes[2].unknown3, "\x04\x02\x60\x54", 4); | |
117 | ||
118 | dlfb_video_modes[3].col = 0; | |
119 | memcpy(&dlfb_video_modes[3].hclock, "\x42\x24\x38\x36", 4); | |
120 | memcpy(&dlfb_video_modes[3].vclock, "\xC1\x52\xD9\x29", 4); | |
121 | memcpy(&dlfb_video_modes[3].unknown1, "\xEA\xB8\x32\x60\xFF\xFF", 6); | |
122 | dlfb_video_modes[3].xres = 1400; | |
123 | memcpy(&dlfb_video_modes[3].unknown2, "\xC9\x4E\xFF\xFF\xFF\xF2", 6); | |
124 | dlfb_video_modes[3].yres = 1050; | |
125 | memcpy(&dlfb_video_modes[3].unknown3, "\x04\x02\x1E\x5F", 4); | |
88e58b1a RDI |
126 | } |
127 | ||
4b6a4856 | 128 | static char *dlfb_set_register(char *bufptr, uint8_t reg, uint8_t val) |
88e58b1a | 129 | { |
88e58b1a RDI |
130 | *bufptr++ = 0xAF; |
131 | *bufptr++ = 0x20; | |
132 | *bufptr++ = reg; | |
133 | *bufptr++ = val; | |
134 | ||
135 | return bufptr; | |
88e58b1a RDI |
136 | } |
137 | ||
4b6a4856 | 138 | static int dlfb_set_video_mode(struct dlfb_data *dev_info, int width, int height) |
88e58b1a | 139 | { |
88e58b1a RDI |
140 | int i, ret; |
141 | unsigned char j; | |
142 | char *bufptr = dev_info->buf; | |
143 | uint8_t *vdata; | |
144 | ||
145 | for (i = 0; i < MAX_VMODES; i++) { | |
146 | printk("INIT VIDEO %d %d %d\n", i, dlfb_video_modes[i].xres, | |
147 | dlfb_video_modes[i].yres); | |
148 | if (dlfb_video_modes[i].xres == width | |
149 | && dlfb_video_modes[i].yres == height) { | |
150 | ||
151 | dev_info->base16 = 0; | |
7316bc55 | 152 | dev_info->base16d = width * height * (FB_BPP / 8); |
88e58b1a | 153 | |
7316bc55 RDI |
154 | //dev_info->base8 = width * height * (FB_BPP / 8); |
155 | ||
156 | dev_info->base8 = dev_info->base16; | |
157 | dev_info->base8d = dev_info->base16d; | |
88e58b1a | 158 | |
39e7df5d | 159 | /* set encryption key (null) */ |
88e58b1a RDI |
160 | memcpy(dev_info->buf, STD_CHANNEL, 16); |
161 | ret = | |
162 | usb_control_msg(dev_info->udev, | |
163 | usb_sndctrlpipe(dev_info->udev, 0), | |
164 | 0x12, (0x02 << 5), 0, 0, | |
165 | dev_info->buf, 16, 0); | |
166 | printk("ret control msg 1 (STD_CHANNEL): %d\n", ret); | |
167 | ||
39e7df5d | 168 | /* set registers */ |
88e58b1a RDI |
169 | bufptr = dlfb_set_register(bufptr, 0xFF, 0x00); |
170 | ||
7316bc55 RDI |
171 | /* set color depth */ |
172 | bufptr = dlfb_set_register(bufptr, 0x00, 0x00); | |
173 | ||
39e7df5d | 174 | /* set addresses */ |
88e58b1a RDI |
175 | bufptr = |
176 | dlfb_set_register(bufptr, 0x20, | |
177 | (char)(dev_info->base16 >> 16)); | |
178 | bufptr = | |
179 | dlfb_set_register(bufptr, 0x21, | |
180 | (char)(dev_info->base16 >> 8)); | |
181 | bufptr = | |
182 | dlfb_set_register(bufptr, 0x22, | |
183 | (char)(dev_info->base16)); | |
184 | ||
185 | bufptr = | |
186 | dlfb_set_register(bufptr, 0x26, | |
187 | (char)(dev_info->base8 >> 16)); | |
188 | bufptr = | |
189 | dlfb_set_register(bufptr, 0x27, | |
190 | (char)(dev_info->base8 >> 8)); | |
191 | bufptr = | |
192 | dlfb_set_register(bufptr, 0x28, | |
193 | (char)(dev_info->base8)); | |
194 | ||
39e7df5d GKH |
195 | /* set video mode */ |
196 | vdata = (uint8_t *)&dlfb_video_modes[i]; | |
197 | for (j = 0; j < 29; j++) | |
88e58b1a | 198 | bufptr = dlfb_set_register(bufptr, j, vdata[j]); |
88e58b1a | 199 | |
39e7df5d | 200 | /* blank */ |
88e58b1a RDI |
201 | bufptr = dlfb_set_register(bufptr, 0x1F, 0x00); |
202 | ||
39e7df5d | 203 | /* end registers */ |
88e58b1a RDI |
204 | bufptr = dlfb_set_register(bufptr, 0xFF, 0xFF); |
205 | ||
39e7df5d | 206 | /* send */ |
88e58b1a | 207 | ret = dlfb_bulk_msg(dev_info, bufptr - dev_info->buf); |
f66abce7 | 208 | printk("ret bulk 2: %d %td\n", ret, |
88e58b1a RDI |
209 | bufptr - dev_info->buf); |
210 | ||
39e7df5d | 211 | /* flush */ |
88e58b1a RDI |
212 | ret = dlfb_bulk_msg(dev_info, 0); |
213 | printk("ret bulk 3: %d\n", ret); | |
214 | ||
215 | dev_info->screen_size = width * height * (FB_BPP / 8); | |
216 | dev_info->line_length = width * (FB_BPP / 8); | |
217 | ||
218 | return 0; | |
219 | } | |
220 | } | |
221 | ||
222 | return -1; | |
223 | } | |
39e7df5d GKH |
224 | |
225 | #endif |