am7xxx: support other devices which talk the same protocol
[libam7xxx.git] / src / picoproj.c
1 /* picoproj - test program for libam7xxx
2  *
3  * Copyright (C) 2012  Antonio Ospite <ospite@studenti.unina.it>
4  *
5  * This program is free software: you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation, either version 2 of the License, or
8  * (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
17  */
18
19 #include <stdio.h>
20 #include <stdlib.h>
21 #include <string.h>
22 #include <sys/mman.h>
23 #include <sys/types.h>
24 #include <sys/stat.h>
25 #include <fcntl.h>
26 #include <unistd.h>
27
28 #include "am7xxx.h"
29
30 static void usage(char *name)
31 {
32         printf("usage: %s [OPTIONS]\n\n", name);
33         printf("OPTIONS:\n");
34         printf("\t-f <filename>\t\tthe image file to upload\n");
35         printf("\t-F <format>\t\tthe image format to use (default is JPEG).\n");
36         printf("\t\t\t\tSUPPORTED FORMATS:\n");
37         printf("\t\t\t\t\t1 - JPEG\n");
38         printf("\t\t\t\t\t2 - YUV - NV12\n");
39         printf("\t-W <image width>\tthe width of the image to upload\n");
40         printf("\t-H <image height>\tthe height of the image to upload\n");
41         printf("\t-h \t\t\tthis help message\n");
42 }
43
44 int main(int argc, char *argv[])
45 {
46         int ret;
47         int exit_code = EXIT_SUCCESS;
48         int opt;
49
50         char filename[FILENAME_MAX] = {0};
51         int image_fd;
52         struct stat st;
53         am7xxx_device *dev;
54         int format = AM7XXX_IMAGE_FORMAT_JPEG;
55         int width = 800;
56         int height = 480;
57         unsigned char *image;
58         unsigned int size;
59         unsigned int native_width;
60         unsigned int native_height;
61         unsigned int unknown0;
62         unsigned int unknown1;
63
64         while ((opt = getopt(argc, argv, "f:F:W:H:h")) != -1) {
65                 switch (opt) {
66                 case 'f':
67                         strncpy(filename, optarg, FILENAME_MAX);
68                         break;
69                 case 'F':
70                         format = atoi(optarg);
71                         switch(format) {
72                         case AM7XXX_IMAGE_FORMAT_JPEG:
73                                 fprintf(stdout, "JPEG format\n");
74                                 break;
75                         case AM7XXX_IMAGE_FORMAT_NV12:
76                                 fprintf(stdout, "NV12 format\n");
77                                 break;
78                         default:
79                                 fprintf(stderr, "Unsupported format\n");
80                                 exit(EXIT_FAILURE);
81                         }
82                         break;
83                 case 'W':
84                         width = atoi(optarg);
85                         if (width < 0) {
86                                 fprintf(stderr, "Unsupported width\n");
87                                 exit(EXIT_FAILURE);
88                         }
89                         break;
90                 case 'H':
91                         height = atoi(optarg);
92                         if (height < 0) {
93                                 fprintf(stderr, "Unsupported height\n");
94                                 exit(EXIT_FAILURE);
95                         }
96                         break;
97                 case 'h':
98                         usage(argv[0]);
99                         exit(EXIT_SUCCESS);
100                         break;
101                 default: /* '?' */
102                         usage(argv[0]);
103                         exit(EXIT_FAILURE);
104                 }
105         }
106
107         if (filename[0] == '\0') {
108                 fprintf(stderr, "An image file MUST be specified.\n");
109                 exit_code = EXIT_FAILURE;
110                 goto out;
111         }
112
113         image_fd = open(filename, O_RDONLY);
114         if (image_fd < 0) {
115                 perror("open");
116                 exit_code = EXIT_FAILURE;
117                 goto out;
118         }
119         if (fstat(image_fd, &st) < 0) {
120                 perror("fstat");
121                 exit_code = EXIT_FAILURE;
122                 goto out_close_image_fd;
123         }
124         size = st.st_size;
125
126         image = mmap(NULL, st.st_size, PROT_READ, MAP_SHARED, image_fd, 0);
127         if (image == NULL) {
128                 perror("mmap");
129                 exit_code = EXIT_FAILURE;
130                 goto out_close_image_fd;
131         }
132
133         dev = am7xxx_init();
134         if (dev == NULL) {
135                 perror("am7xxx_init");
136                 exit_code = EXIT_FAILURE;
137                 goto out_munmap;
138         }
139
140         ret = am7xxx_get_device_info(dev, &native_width, &native_height, &unknown0, &unknown1);
141         if (ret < 0) {
142                 perror("am7xxx_get_info");
143                 exit_code = EXIT_FAILURE;
144                 goto cleanup;
145         }
146         printf("Native resolution: %dx%d\n", native_width, native_height);
147         printf("Unknown0: %d\n", unknown0);
148         printf("Unknown1: %d\n", unknown1);
149
150         ret = am7xxx_set_power_mode(dev, AM7XXX_POWER_LOW);
151         if (ret < 0) {
152                 perror("am7xxx_set_power_mode");
153                 exit_code = EXIT_FAILURE;
154                 goto cleanup;
155         }
156
157         ret = am7xxx_send_image(dev, format, width, height, image, size);
158         if (ret < 0) {
159                 perror("am7xxx_send_image");
160                 exit_code = EXIT_FAILURE;
161                 goto cleanup;
162         }
163
164         exit_code = EXIT_SUCCESS;
165
166 cleanup:
167         am7xxx_shutdown(dev);
168
169 out_munmap:
170         ret = munmap(image, size);
171         if (ret < 0)
172                 perror("munmap");
173
174 out_close_image_fd:
175         ret = close(image_fd);
176         if (ret < 0)
177                 perror("close");
178
179 out:
180         exit(exit_code);
181 }