1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
|
/* Most of the codes are copied from V4L2 sample capture.c, see
* Video for Linux Two API Specification
* http://v4l2spec.bytesex.org/spec-single/v4l2.html#CAPTURE-EXAMPLE
*/
/* for buffer sharing between CI and VA */
#ifndef _CI_VA_H
#define _CI_VA_H
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.h> /* low-level i/o */
#include <unistd.h>
#include <errno.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <sys/ioctl.h>
struct ci_frame_info {
unsigned long frame_id; /* in */
unsigned int width; /* out */
unsigned int height; /* out */
unsigned int stride; /* out */
unsigned int fourcc; /* out */
unsigned int offset; /* out */
};
#define ISP_IOCTL_GET_FRAME_INFO _IOWR('V', 192 + 5, struct ci_frame_info)
static int
open_device(char *dev_name)
{
struct stat st;
int fd;
if (-1 == stat(dev_name, &st)) {
fprintf(stderr, "Cannot identify '%s': %d, %s\n",
dev_name, errno, strerror(errno));
return -1;
}
if (!S_ISCHR(st.st_mode)) {
fprintf(stderr, "%s is no device\n", dev_name);
return -1;
}
fd = open(dev_name, O_RDWR /* required */ | O_NONBLOCK, 0);
if (-1 == fd) {
fprintf(stderr, "Cannot open '%s': %d, %s\n",
dev_name, errno, strerror(errno));
return -1;
}
return fd;
}
static int
close_device(int fd)
{
if (-1 == close(fd)) {
fprintf(stderr, "close device failed\n");
return -1;
}
return 0;
}
static int
xioctl(int fd, int request, void *arg)
{
int r;
do
r = ioctl(fd, request, arg);
while (-1 == r && EINTR == errno);
return r;
}
static int
ci_get_frame_info(int fd, struct ci_frame_info *frame_info)
{
if (-1 == xioctl(fd, ISP_IOCTL_GET_FRAME_INFO, frame_info)) {
if (EINVAL == errno) {
fprintf(stderr, "Camear IOCTL ISP_IOCTL_GET_FRAME_INFO failed\n");
return -1;
} else {
fprintf(stderr, "Camear IOCTL ISP_IOCTL_GET_FRAME_INFO failed\n");
return -1;
}
}
return 0;
}
#endif
|