Mercurial > hg > minimon
annotate 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 | bac8ed8d6eb9 |
children |
rev | line source |
---|---|
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
1 #include <stdlib.h> |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
2 #include <stdio.h> |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
3 #include <string.h> |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
4 #include <fcntl.h> |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
5 #include <sys/ioctl.h> |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
6 #include <sys/mman.h> |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
7 #include <assert.h> |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
8 #include "usb.h" |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
9 |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
10 #include "linux/fb.h" |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
11 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
12 #include "common.h" |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
13 |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
14 static const char *progname = "minimon"; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
15 |
1 | 16 static int need_switch = 0; |
17 static int have_idx = -1; | |
18 | |
19 typedef struct { | |
20 int mass_id; | |
21 int custom_id; | |
22 const char *name; | |
23 int width; | |
24 int height; | |
25 } id_info_t; | |
26 | |
2
bac8ed8d6eb9
add jpeg coding and test stuff
Peter Meerwald <pmeerw@pmeerw.net>
parents:
1
diff
changeset
|
27 // there are many more, |
1 | 28 static id_info_t ids[] = { |
2
bac8ed8d6eb9
add jpeg coding and test stuff
Peter Meerwald <pmeerw@pmeerw.net>
parents:
1
diff
changeset
|
29 {0x2027, 0x2028, "SPF-107H", 1024, 600}, |
1 | 30 {0xffff, 0xffff, "SPF-75H", 800, 480}, |
2
bac8ed8d6eb9
add jpeg coding and test stuff
Peter Meerwald <pmeerw@pmeerw.net>
parents:
1
diff
changeset
|
31 {0xffff, 0xffff, "SPF-83H", 800, 600}, |
1 | 32 {0xffff, 0xffff, "SPF-85H", 800, 600}, // 85P?? |
33 {0x2033, 0x2034, "SPF-87H", 800, 480}, | |
34 {0x2035, 0x2036, "SPF-107H", 1024, 600}, | |
35 {0, 0, } // end-of-list | |
36 }; | |
37 | |
38 static int in_list(int id, id_info_t *list) { | |
39 if (!list) | |
40 return 0; | |
41 | |
42 int idx = 0; | |
43 while (list->mass_id || list->custom_id) { | |
44 if (id == list->mass_id) { | |
45 // still in mass-storage mode, need to switch | |
46 need_switch = 1; | |
47 return idx; | |
48 } | |
49 else if (id == list->custom_id) { | |
50 need_switch = 0; | |
51 return idx; | |
52 } | |
53 idx++; | |
54 list++; | |
55 } | |
56 | |
57 return -1; | |
58 } | |
59 | |
60 static struct usb_device *find_dev() { | |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
61 struct usb_bus *bus; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
62 struct usb_device *dev; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
63 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
64 usb_init(); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
65 usb_find_busses(); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
66 usb_find_devices(); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
67 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
68 for (bus = usb_busses; bus; bus = bus->next) { |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
69 for (dev = bus->devices; dev; dev = dev->next) { |
1 | 70 if (dev->descriptor.idVendor == 0x04e8) { |
71 // found a Samsung device, good | |
72 int idx = -1; | |
73 if ((idx = in_list(dev->descriptor.idProduct, ids)) >= 0) { | |
74 have_idx = idx; | |
75 return dev; | |
76 } | |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
77 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
78 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
79 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
80 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
81 return NULL; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
82 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
83 |
1 | 84 static usb_dev_handle *dev_open(struct usb_device *dev) { |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
85 int res = -1; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
86 usb_dev_handle *udev; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
87 int numeps = 0; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
88 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
89 udev = usb_open(dev); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
90 if (!udev) { |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
91 fprintf(stderr, "%s: failed to open device, exit.\n", progname); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
92 exit(EXIT_FAILURE); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
93 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
94 |
2
bac8ed8d6eb9
add jpeg coding and test stuff
Peter Meerwald <pmeerw@pmeerw.net>
parents:
1
diff
changeset
|
95 // setuid(getuid()); |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
96 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
97 res = usb_set_configuration(udev, 1); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
98 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
99 usb_claim_interface(udev, 0); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
100 numeps = dev->config[0].interface[0].altsetting[0].bNumEndpoints; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
101 if (numeps == 0) { |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
102 fprintf(stderr, "%s: no endpoints, exit.\n", progname); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
103 exit(EXIT_FAILURE); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
104 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
105 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
106 { |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
107 int eplist[] = { 0x2, 0x81, 0x83 }; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
108 int eplength = sizeof(eplist)/sizeof(eplist[0]); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
109 int *endpoint = eplist; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
110 int i; |
1 | 111 for (i = 0; i < eplength; i++) { |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
112 res = usb_resetep(udev, *endpoint); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
113 res = usb_clear_halt(udev, *endpoint); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
114 endpoint++; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
115 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
116 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
117 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
118 return udev; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
119 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
120 |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
121 static int send_jpg(jpg_buf_t *jpg_buf, usb_dev_handle *udev) { |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
122 #define URBBUF_MAX 0x20000 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
123 char buf[URBBUF_MAX]; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
124 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
125 #define HDR_LEN 12 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
126 char hdr[HDR_LEN] = {0xa5, 0x5a, 0x18, 0x04, 0xff, 0xff, 0xff, 0xff, 0x48, 0x00, 0x00, 0x00}; |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
127 *(int *)(hdr+4) = jpg_buf->size; |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
128 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
129 memcpy(buf, hdr, HDR_LEN); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
130 int off = HDR_LEN; |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
131 int jpg_off = 0; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
132 int jpg_left = jpg_buf->size; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
133 while (jpg_left > 0) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
134 int nr = MIN(URBBUF_MAX - off, jpg_left); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
135 memcpy(buf+off, &jpg_buf->ptr[jpg_off], nr); |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
136 // pad |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
137 memset(buf + off + nr, 0, URBBUF_MAX - off - nr); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
138 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
139 // write it out chunk by chunk |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
140 int timeout = 1000; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
141 int endpoint = 0x2; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
142 int res = usb_bulk_write(udev, endpoint, buf, URBBUF_MAX, timeout); |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
143 |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
144 if (res < 0) |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
145 return 0; |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
146 off = 0; // no header on subsequent chunks |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
147 jpg_off += nr; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
148 jpg_left -= nr; |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
149 } |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
150 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
151 return 1; |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
152 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
153 |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
154 int main(int argc, char *argv[]) { |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
155 if (argc != 2) { |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
156 fprintf(stderr, "Usage: %s </dev/fbX>\n", progname); |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
157 return EXIT_FAILURE; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
158 } |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
159 |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
160 int fd = open(argv[1], O_RDONLY); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
161 if (fd < 0) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
162 perror("minimon framebuffer"); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
163 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
164 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
165 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
166 struct fb_fix_screeninfo sif; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
167 if (ioctl(fd, FBIOGET_FSCREENINFO, &sif) < 0) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
168 perror("minimon framebuffer info"); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
169 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
170 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
171 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
172 printf("id %s\n", sif.id); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
173 printf("type %d, aux %d\n", sif.type, sif.type_aux); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
174 printf("visual %d\n", sif.visual); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
175 printf("accel %d\n", sif.accel); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
176 printf("line length %d\n", sif.line_length); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
177 printf("mem %d\n", sif.smem_len); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
178 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
179 struct fb_var_screeninfo siv; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
180 if (ioctl(fd, FBIOGET_VSCREENINFO, &siv) < 0) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
181 perror("minimon framebuffer info"); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
182 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
183 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
184 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
185 printf("res x %d y %d\n", siv.xres, siv.yres); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
186 printf("bpp %d\n", siv.bits_per_pixel); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
187 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
188 size_t fb_mem_size = siv.xres * siv.yres * siv.bits_per_pixel / 8; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
189 void *fb_mem = mmap(NULL, fb_mem_size, PROT_READ, MAP_SHARED, fd, 0); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
190 if (fb_mem == MAP_FAILED) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
191 perror("minimon framebuffer mapping"); |
1 | 192 exit(EXIT_FAILURE); |
193 } | |
194 | |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
195 while (1) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
196 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:
2
diff
changeset
|
197 if (!dev) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
198 fprintf(stderr, "%s: no photo frame device found, suspending...\n", progname); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
199 sleep(1); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
200 continue; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
201 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
202 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
203 if (need_switch) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
204 fprintf(stderr, "%s: found %s, trying to switch to custom product mode...\n", |
1 | 205 ids[have_idx].name, progname); |
206 | |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
207 usb_dev_handle *udev; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
208 udev = usb_open(dev); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
209 if (!udev) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
210 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:
2
diff
changeset
|
211 exit(EXIT_FAILURE); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
212 } |
1 | 213 |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
214 char buf[254]; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
215 memset(buf, 0, 254); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
216 int res = usb_control_msg(udev, USB_TYPE_STANDARD | USB_ENDPOINT_IN, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
217 0x06, 0xfe, 0xfe, buf, 0xfe, 1000); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
218 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:
2
diff
changeset
|
219 usb_close(udev); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
220 sleep(1); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
221 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
222 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
223 dev = find_dev(index); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
224 if (!dev || need_switch) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
225 fprintf(stderr, "%s: no photo frame device found, suspending...\n", progname); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
226 sleep(1); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
227 continue; |
1 | 228 } |
229 | |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
230 int mon_width = ids[have_idx].width; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
231 int mon_height = ids[have_idx].height; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
232 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:
2
diff
changeset
|
233 progname, ids[have_idx].name, mon_width, mon_height); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
234 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
235 usb_dev_handle *udev = dev_open(dev); |
1 | 236 |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
237 while (1) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
238 int transfer = 1; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
239 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
240 // poll status to avoid going back to photoframe mode |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
241 char buf[2]; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
242 int res = usb_control_msg(udev, USB_TYPE_VENDOR | USB_ENDPOINT_IN, |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
243 0x06, 0x0, 0x0, buf, 0x2, 1000); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
244 if (res != 2) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
245 break; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
246 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
247 else if (buf[0] != 0) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
248 transfer = 0; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
249 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
250 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
251 if (transfer) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
252 fprintf(stderr, "."); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
253 jpg_buf_t jpg_buf = build_jpg_from_fb((unsigned char *)fb_mem, siv.xres, siv.yres, siv.bits_per_pixel, mon_width, mon_height); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
254 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
255 if (!send_jpg(&jpg_buf, udev)) { |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
256 free(jpg_buf.ptr); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
257 break; |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
258 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
259 free(jpg_buf.ptr); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
260 } |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
261 else |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
262 fprintf(stderr, "o"); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
263 |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
264 usleep(500000); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
265 } |
1 | 266 |
267 usb_close(udev); | |
268 } | |
269 | |
10
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
270 munmap(fb_mem, fb_mem_size); |
078dc69945ad
working: libjpeg-turbo support, handle fb and monitor with different size
Peter Meerwald <pmeerw@pmeerw.net>
parents:
2
diff
changeset
|
271 close(fd); |
2
bac8ed8d6eb9
add jpeg coding and test stuff
Peter Meerwald <pmeerw@pmeerw.net>
parents:
1
diff
changeset
|
272 |
0
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
273 return EXIT_SUCCESS; |
71b9540bdd23
starting, importing Woo's code and adding minimon
Peter Meerwald <pmeerw@pmeerw.net>
parents:
diff
changeset
|
274 } |