Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 1 | #ifndef UDLFB_H |
| 2 | #define UDLFB_H |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 3 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 4 | #define MAX_VMODES 4 |
| 5 | #define FB_BPP 16 |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 6 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 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) |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 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; |
Roberto De Ioris | 7316bc5 | 2009-06-10 23:02:19 -0700 | [diff] [blame] | 29 | int base16d; |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 30 | int base8; |
Roberto De Ioris | 7316bc5 | 2009-06-10 23:02:19 -0700 | [diff] [blame] | 31 | int base8d; |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 32 | }; |
| 33 | |
| 34 | struct dlfb_video_mode { |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 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]; |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 43 | } __attribute__ ((__packed__)); |
| 44 | |
Greg Kroah-Hartman | 4b6a485 | 2009-06-03 14:47:21 -0700 | [diff] [blame] | 45 | static struct dlfb_video_mode dlfb_video_modes[MAX_VMODES]; |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 46 | |
| 47 | static void dlfb_bulk_callback(struct urb *urb) |
| 48 | { |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 49 | struct dlfb_data *dev_info = urb->context; |
| 50 | complete(&dev_info->done); |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 51 | } |
| 52 | |
Roberto De Ioris | 7316bc5 | 2009-06-10 23:02:19 -0700 | [diff] [blame] | 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 | |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 71 | static int dlfb_bulk_msg(struct dlfb_data *dev_info, int len) |
| 72 | { |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 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; |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 87 | } |
| 88 | |
Greg Kroah-Hartman | 4b6a485 | 2009-06-03 14:47:21 -0700 | [diff] [blame] | 89 | static void dlfb_init_modes(void) |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 90 | { |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 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); |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 126 | } |
| 127 | |
Greg Kroah-Hartman | 4b6a485 | 2009-06-03 14:47:21 -0700 | [diff] [blame] | 128 | static char *dlfb_set_register(char *bufptr, uint8_t reg, uint8_t val) |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 129 | { |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 130 | *bufptr++ = 0xAF; |
| 131 | *bufptr++ = 0x20; |
| 132 | *bufptr++ = reg; |
| 133 | *bufptr++ = val; |
| 134 | |
| 135 | return bufptr; |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 136 | } |
| 137 | |
Greg Kroah-Hartman | 4b6a485 | 2009-06-03 14:47:21 -0700 | [diff] [blame] | 138 | static int dlfb_set_video_mode(struct dlfb_data *dev_info, int width, int height) |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 139 | { |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 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; |
Roberto De Ioris | 7316bc5 | 2009-06-10 23:02:19 -0700 | [diff] [blame] | 152 | dev_info->base16d = width * height * (FB_BPP / 8); |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 153 | |
Roberto De Ioris | 7316bc5 | 2009-06-10 23:02:19 -0700 | [diff] [blame] | 154 | //dev_info->base8 = width * height * (FB_BPP / 8); |
| 155 | |
| 156 | dev_info->base8 = dev_info->base16; |
| 157 | dev_info->base8d = dev_info->base16d; |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 158 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 159 | /* set encryption key (null) */ |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 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 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 168 | /* set registers */ |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 169 | bufptr = dlfb_set_register(bufptr, 0xFF, 0x00); |
| 170 | |
Roberto De Ioris | 7316bc5 | 2009-06-10 23:02:19 -0700 | [diff] [blame] | 171 | /* set color depth */ |
| 172 | bufptr = dlfb_set_register(bufptr, 0x00, 0x00); |
| 173 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 174 | /* set addresses */ |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 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 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 195 | /* set video mode */ |
| 196 | vdata = (uint8_t *)&dlfb_video_modes[i]; |
| 197 | for (j = 0; j < 29; j++) |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 198 | bufptr = dlfb_set_register(bufptr, j, vdata[j]); |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 199 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 200 | /* blank */ |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 201 | bufptr = dlfb_set_register(bufptr, 0x1F, 0x00); |
| 202 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 203 | /* end registers */ |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 204 | bufptr = dlfb_set_register(bufptr, 0xFF, 0xFF); |
| 205 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 206 | /* send */ |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 207 | ret = dlfb_bulk_msg(dev_info, bufptr - dev_info->buf); |
| 208 | printk("ret bulk 2: %d %d\n", ret, |
| 209 | bufptr - dev_info->buf); |
| 210 | |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 211 | /* flush */ |
Roberto De Ioris | 88e58b1 | 2009-06-03 14:03:06 -0700 | [diff] [blame] | 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 | } |
Greg Kroah-Hartman | 39e7df5 | 2009-06-03 14:47:00 -0700 | [diff] [blame] | 224 | |
| 225 | #endif |