minimon: minimon.c annotate

annotate minimon.c @ 11:8fadd7877f6b default tip

build only minimon per default

author	Peter Meerwald <pmeerw@pmeerw.net>
date	Sun, 15 May 2011 18:58:44 +0200
parents	078dc69945ad
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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	16 static int need_switch = 0;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	17 static int have_idx = -1;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	18
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	19 typedef struct {
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	20 int mass_id;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	21 int custom_id;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	22 const char *name;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	23 int width;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	24 int height;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	25 } id_info_t;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	26
2 bac8ed8d6eb9 add jpeg coding and test stuff Peter Meerwald <pmeerw@pmeerw.net> parents: 1 diff changeset	27 // there are many more,
1 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	32 {0xffff, 0xffff, "SPF-85H", 800, 600}, // 85P??
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	33 {0x2033, 0x2034, "SPF-87H", 800, 480},
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	34 {0x2035, 0x2036, "SPF-107H", 1024, 600},
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	35 {0, 0, } // end-of-list
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	36 };
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	37
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	38 static int in_list(int id, id_info_t *list) {
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	39 if (!list)
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	40 return 0;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	41
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	42 int idx = 0;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	43 while (list->mass_id \|\| list->custom_id) {
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	44 if (id == list->mass_id) {
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	45 // still in mass-storage mode, need to switch
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	46 need_switch = 1;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	47 return idx;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	48 }
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	49 else if (id == list->custom_id) {
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	50 need_switch = 0;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	51 return idx;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	52 }
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	53 idx++;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	54 list++;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	55 }
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	56
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	57 return -1;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	58 }
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	59
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	70 if (dev->descriptor.idVendor == 0x04e8) {
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	71 // found a Samsung device, good
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	72 int idx = -1;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	73 if ((idx = in_list(dev->descriptor.idProduct, ids)) >= 0) {
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	74 have_idx = idx;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	75 return dev;
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	192 exit(EXIT_FAILURE);
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	193 }
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	205 ids[have_idx].name, progname);
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	228 }
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	266
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	267 usb_close(udev);
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	268 }
111d4bbce605 improving Peter Meerwald <pmeerw@pmeerw.net> parents: 0 diff changeset	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 }

Mercurial > hg > minimon

annotate minimon.c @ 11:8fadd7877f6b default tip