Print all links in media_print_topology_text()
[media-ctl.git] / src / subdev.c
1 /*
2  * Media controller test application
3  *
4  * Copyright (C) 2010 Ideas on board SPRL <laurent.pinchart@ideasonboard.com>
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License along
17  * with this program; if not, write to the Free Software Foundation, Inc.,
18  */
19
20 #include <sys/ioctl.h>
21 #include <sys/stat.h>
22 #include <sys/types.h>
23
24 #include <errno.h>
25 #include <fcntl.h>
26 #include <stdio.h>
27 #include <string.h>
28 #include <unistd.h>
29
30 #include <linux/v4l2-subdev.h>
31
32 #include "media.h"
33 #include "subdev.h"
34 #include "tools.h"
35
36 int v4l2_subdev_open(struct media_entity *entity)
37 {
38         if (entity->fd != -1)
39                 return 0;
40
41         entity->fd = open(entity->devname, O_RDWR);
42         if (entity->fd == -1) {
43                 printf("%s: Failed to open subdev device node %s\n", __func__,
44                         entity->devname);
45                 return -errno;
46         }
47
48         return 0;
49 }
50
51 void v4l2_subdev_close(struct media_entity *entity)
52 {
53         close(entity->fd);
54 }
55
56 int v4l2_subdev_get_format(struct media_entity *entity,
57         struct v4l2_mbus_framefmt *format, unsigned int pad,
58         enum v4l2_subdev_format_whence which)
59 {
60         struct v4l2_subdev_format fmt;
61         int ret;
62
63         ret = v4l2_subdev_open(entity);
64         if (ret < 0)
65                 return ret;
66
67         memset(&fmt, 0, sizeof(fmt));
68         fmt.pad = pad;
69         fmt.which = which;
70
71         ret = ioctl(entity->fd, VIDIOC_SUBDEV_G_FMT, &fmt);
72         if (ret < 0)
73                 return -errno;
74
75         *format = fmt.format;
76         return 0;
77 }
78
79 int v4l2_subdev_set_format(struct media_entity *entity,
80         struct v4l2_mbus_framefmt *format, unsigned int pad,
81         enum v4l2_subdev_format_whence which)
82 {
83         struct v4l2_subdev_format fmt;
84         int ret;
85
86         ret = v4l2_subdev_open(entity);
87         if (ret < 0)
88                 return ret;
89
90         memset(&fmt, 0, sizeof(fmt));
91         fmt.pad = pad;
92         fmt.which = which;
93         fmt.format = *format;
94
95         ret = ioctl(entity->fd, VIDIOC_SUBDEV_S_FMT, &fmt);
96         if (ret < 0)
97                 return -errno;
98
99         *format = fmt.format;
100         return 0;
101 }
102
103 int v4l2_subdev_get_crop(struct media_entity *entity, struct v4l2_rect *rect,
104                          unsigned int pad, enum v4l2_subdev_format_whence which)
105 {
106         struct v4l2_subdev_crop crop;
107         int ret;
108
109         ret = v4l2_subdev_open(entity);
110         if (ret < 0)
111                 return ret;
112
113         memset(&crop, 0, sizeof(crop));
114         crop.pad = pad;
115         crop.which = which;
116
117         ret = ioctl(entity->fd, VIDIOC_SUBDEV_G_CROP, &crop);
118         if (ret < 0)
119                 return -errno;
120
121         *rect = crop.rect;
122         return 0;
123 }
124
125 int v4l2_subdev_set_crop(struct media_entity *entity, struct v4l2_rect *rect,
126                          unsigned int pad, enum v4l2_subdev_format_whence which)
127 {
128         struct v4l2_subdev_crop crop;
129         int ret;
130
131         ret = v4l2_subdev_open(entity);
132         if (ret < 0)
133                 return ret;
134
135         memset(&crop, 0, sizeof(crop));
136         crop.pad = pad;
137         crop.which = which;
138         crop.rect = *rect;
139
140         ret = ioctl(entity->fd, VIDIOC_SUBDEV_S_CROP, &crop);
141         if (ret < 0)
142                 return -errno;
143
144         *rect = crop.rect;
145         return 0;
146 }
147
148 int v4l2_subdev_get_frame_interval(struct media_entity *entity,
149                                    struct v4l2_fract *interval)
150 {
151         struct v4l2_subdev_frame_interval ival;
152         int ret;
153
154         ret = v4l2_subdev_open(entity);
155         if (ret < 0)
156                 return ret;
157
158         memset(&ival, 0, sizeof(ival));
159
160         ret = ioctl(entity->fd, VIDIOC_SUBDEV_G_FRAME_INTERVAL, &ival);
161         if (ret < 0)
162                 return -errno;
163
164         *interval = ival.interval;
165         return 0;
166 }
167
168 int v4l2_subdev_set_frame_interval(struct media_entity *entity,
169                                    struct v4l2_fract *interval)
170 {
171         struct v4l2_subdev_frame_interval ival;
172         int ret;
173
174         ret = v4l2_subdev_open(entity);
175         if (ret < 0)
176                 return ret;
177
178         memset(&ival, 0, sizeof(ival));
179         ival.interval = *interval;
180
181         ret = ioctl(entity->fd, VIDIOC_SUBDEV_S_FRAME_INTERVAL, &ival);
182         if (ret < 0)
183                 return -errno;
184
185         *interval = ival.interval;
186         return 0;
187 }