Mercurial > hg > minimon
annotate disp-minimon.c @ 10:078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
author | Peter Meerwald <pmeerw@pmeerw.net> |
---|---|
date | Sun, 15 May 2011 17:48:57 +0200 |
parents | |
children |
rev | line source |
---|---|
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
1 #include <stdlib.h> |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
2 #include <stdio.h> |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
3 #include <string.h> |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
4 #include <fcntl.h> |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
5 #include <assert.h> |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
6 #include "usb.h" |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
7 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
8 static const char *progname = "minimon"; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
9 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
10 static int need_switch = 0; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
11 static int have_idx = -1; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
12 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
13 typedef struct { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
14 int mass_id; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
15 int custom_id; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
16 const char *name; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
17 int width; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
18 int height; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
19 } id_info_t; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
20 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
21 // there are many more, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
22 static id_info_t ids[] = { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
23 {0x2027, 0x2028, "SPF-107H", 1024, 600}, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
24 {0xffff, 0xffff, "SPF-75H", 800, 480}, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
25 {0xffff, 0xffff, "SPF-83H", 800, 600}, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
26 {0xffff, 0xffff, "SPF-85H", 800, 600}, // 85P?? |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
27 {0x2033, 0x2034, "SPF-87H", 800, 480}, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
28 {0x2035, 0x2036, "SPF-107H", 1024, 600}, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
29 {0, 0, } // end-of-list |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
30 }; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
31 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
32 static int in_list(int id, id_info_t *list) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
33 if (!list) |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
34 return 0; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
35 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
36 int idx = 0; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
37 while (list->mass_id || list->custom_id) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
38 if (id == list->mass_id) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
39 // still in mass-storage mode, need to switch |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
40 need_switch = 1; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
41 return idx; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
42 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
43 else if (id == list->custom_id) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
44 need_switch = 0; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
45 return idx; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
46 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
47 idx++; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
48 list++; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
49 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
50 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
51 return -1; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
52 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
53 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
54 static struct usb_device *find_dev() { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
55 struct usb_bus *bus; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
56 struct usb_device *dev; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
57 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
58 usb_init(); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
59 usb_find_busses(); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
60 usb_find_devices(); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
61 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
62 for (bus = usb_busses; bus; bus = bus->next) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
63 for (dev = bus->devices; dev; dev = dev->next) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
64 if (dev->descriptor.idVendor == 0x04e8) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
65 // found a Samsung device, good |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
66 int idx = -1; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
67 if ((idx = in_list(dev->descriptor.idProduct, ids)) >= 0) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
68 have_idx = idx; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
69 return dev; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
70 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
71 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
72 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
73 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
74 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
75 return NULL; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
76 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
77 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
78 static usb_dev_handle *dev_open(struct usb_device *dev) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
79 int res = -1; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
80 usb_dev_handle *udev; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
81 int numeps = 0; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
82 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
83 udev = usb_open(dev); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
84 if (!udev) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
85 fprintf(stderr, "%s: failed to open device, exit.\n", progname); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
86 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
87 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
88 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
89 // setuid(getuid()); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
90 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
91 res = usb_set_configuration(udev, 1); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
92 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
93 usb_claim_interface(udev, 0); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
94 numeps = dev->config[0].interface[0].altsetting[0].bNumEndpoints; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
95 if (numeps == 0) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
96 fprintf(stderr, "%s: no endpoints, exit.\n", progname); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
97 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
98 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
99 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
100 { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
101 int eplist[] = { 0x2, 0x81, 0x83 }; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
102 int eplength = sizeof(eplist)/sizeof(eplist[0]); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
103 int *endpoint = eplist; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
104 int i; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
105 for (i = 0; i < eplength; i++) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
106 res = usb_resetep(udev, *endpoint); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
107 res = usb_clear_halt(udev, *endpoint); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
108 endpoint++; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
109 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
110 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
111 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
112 return udev; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
113 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
114 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
115 static void send_jpeg(FILE *f, usb_dev_handle *udev) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
116 fseek(f, 0, SEEK_END); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
117 int sz = ftell(f); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
118 fseek(f, 0, SEEK_SET); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
119 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
120 #define URBBUF_MAX 0x20000 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
121 char buf[URBBUF_MAX]; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
122 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
123 #define HDR_LEN 12 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
124 char hdr[HDR_LEN] = {0xa5, 0x5a, 0x18, 0x04, 0xff, 0xff, 0xff, 0xff, 0x48, 0x00, 0x00, 0x00}; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
125 *(int *)(hdr+4) = sz; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
126 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
127 memcpy(buf, hdr, HDR_LEN); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
128 int off = HDR_LEN; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
129 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
130 while(!feof(f)) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
131 int nr = fread(buf+off, 1, URBBUF_MAX - off, f); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
132 if (nr < 0) break; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
133 // pad |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
134 memset(buf + off + nr, 0, URBBUF_MAX - off - nr); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
135 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
136 // write it out chunk by chunk |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
137 int timeout = 1000; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
138 int endpoint = 0x2; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
139 int res = usb_bulk_write(udev, endpoint, buf, URBBUF_MAX, timeout); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
140 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
141 assert(res >= 0); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
142 off = 0; // no header on subsequent chunks |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
143 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
144 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
145 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
146 int main(int argc, char *argv[]) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
147 if (argc != 2) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
148 fprintf(stderr, "Usage: %s <.jpg file>\n", progname); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
149 return EXIT_FAILURE; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
150 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
151 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
152 struct usb_device *dev = find_dev(index); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
153 if (!dev) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
154 fprintf(stderr, "%s: no photo frame device found, exit.\n", progname); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
155 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
156 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
157 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
158 if (need_switch) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
159 fprintf(stderr, "%s: found %s, trying to switch to custom product mode...\n", |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
160 ids[have_idx].name, progname); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
161 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
162 usb_dev_handle *udev; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
163 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
164 udev = usb_open(dev); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
165 if (!udev) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
166 fprintf(stderr, "%s: failed to open device, exit.\n", progname); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
167 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
168 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
169 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
170 char buf[254]; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
171 memset(buf, 0, 254); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
172 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
173 int res = usb_control_msg(udev, USB_TYPE_STANDARD | USB_ENDPOINT_IN, USB_REQ_GET_DESCRIPTOR, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
174 0xfe, 0xfe, buf, 0xfe, 1000); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
175 fprintf(stderr, "%s: usb_control_msg() = %d\n", progname, res); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
176 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
177 usb_close(udev); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
178 usleep(500000); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
179 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
180 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
181 dev = find_dev(index); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
182 if (!dev || need_switch) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
183 fprintf(stderr, "%s: no photo frame device found, exit.\n", progname); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
184 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
185 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
186 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
187 fprintf(stderr, "%s: found %s (%d x %d)\n", |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
188 progname, ids[have_idx].name, ids[have_idx].width, ids[have_idx].height); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
189 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
190 usb_dev_handle *udev = dev_open(dev); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
191 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
192 FILE *f = fopen(argv[1], "rb"); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
193 if (f == NULL) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
194 fprintf(stderr, "%s: failed to open file '%s', exit.\n", progname, argv[1]); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
195 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
196 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
197 send_jpeg(f, udev); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
198 fclose(f); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
199 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
200 while (1) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
201 char buf[2]; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
202 int res = usb_control_msg(udev, USB_TYPE_VENDOR | USB_ENDPOINT_IN, USB_REQ_GET_DESCRIPTOR, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
203 0x0, 0x0, buf, 0x2, 1000); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
204 fprintf(stderr, "%s: usb_control_msg() = %d\n", progname, res); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
205 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
206 usleep(500000); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
207 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
208 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
209 usb_close(udev); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
210 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
211 return EXIT_SUCCESS; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
212 } |