2 * vsp1_rwpf.c -- R-Car VSP1 Read and Write Pixel Formatters
4 * Copyright (C) 2013-2014 Renesas Electronics Corporation
6 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
14 #include <media/v4l2-subdev.h>
17 #include "vsp1_rwpf.h"
18 #include "vsp1_video.h"
20 #define RWPF_MIN_WIDTH 1
21 #define RWPF_MIN_HEIGHT 1
23 /* -----------------------------------------------------------------------------
24 * V4L2 Subdevice Pad Operations
27 int vsp1_rwpf_enum_mbus_code(struct v4l2_subdev
*subdev
,
28 struct v4l2_subdev_fh
*fh
,
29 struct v4l2_subdev_mbus_code_enum
*code
)
31 static const unsigned int codes
[] = {
32 MEDIA_BUS_FMT_ARGB8888_1X32
,
33 MEDIA_BUS_FMT_AYUV8_1X32
,
36 if (code
->index
>= ARRAY_SIZE(codes
))
39 code
->code
= codes
[code
->index
];
44 int vsp1_rwpf_enum_frame_size(struct v4l2_subdev
*subdev
,
45 struct v4l2_subdev_fh
*fh
,
46 struct v4l2_subdev_frame_size_enum
*fse
)
48 struct vsp1_rwpf
*rwpf
= to_rwpf(subdev
);
49 struct v4l2_mbus_framefmt
*format
;
51 format
= v4l2_subdev_get_try_format(fh
, fse
->pad
);
53 if (fse
->index
|| fse
->code
!= format
->code
)
56 if (fse
->pad
== RWPF_PAD_SINK
) {
57 fse
->min_width
= RWPF_MIN_WIDTH
;
58 fse
->max_width
= rwpf
->max_width
;
59 fse
->min_height
= RWPF_MIN_HEIGHT
;
60 fse
->max_height
= rwpf
->max_height
;
62 /* The size on the source pad are fixed and always identical to
63 * the size on the sink pad.
65 fse
->min_width
= format
->width
;
66 fse
->max_width
= format
->width
;
67 fse
->min_height
= format
->height
;
68 fse
->max_height
= format
->height
;
74 static struct v4l2_rect
*
75 vsp1_rwpf_get_crop(struct vsp1_rwpf
*rwpf
, struct v4l2_subdev_fh
*fh
, u32 which
)
78 case V4L2_SUBDEV_FORMAT_TRY
:
79 return v4l2_subdev_get_try_crop(fh
, RWPF_PAD_SINK
);
80 case V4L2_SUBDEV_FORMAT_ACTIVE
:
87 int vsp1_rwpf_get_format(struct v4l2_subdev
*subdev
, struct v4l2_subdev_fh
*fh
,
88 struct v4l2_subdev_format
*fmt
)
90 struct vsp1_rwpf
*rwpf
= to_rwpf(subdev
);
92 fmt
->format
= *vsp1_entity_get_pad_format(&rwpf
->entity
, fh
, fmt
->pad
,
98 int vsp1_rwpf_set_format(struct v4l2_subdev
*subdev
, struct v4l2_subdev_fh
*fh
,
99 struct v4l2_subdev_format
*fmt
)
101 struct vsp1_rwpf
*rwpf
= to_rwpf(subdev
);
102 struct v4l2_mbus_framefmt
*format
;
103 struct v4l2_rect
*crop
;
105 /* Default to YUV if the requested format is not supported. */
106 if (fmt
->format
.code
!= MEDIA_BUS_FMT_ARGB8888_1X32
&&
107 fmt
->format
.code
!= MEDIA_BUS_FMT_AYUV8_1X32
)
108 fmt
->format
.code
= MEDIA_BUS_FMT_AYUV8_1X32
;
110 format
= vsp1_entity_get_pad_format(&rwpf
->entity
, fh
, fmt
->pad
,
113 if (fmt
->pad
== RWPF_PAD_SOURCE
) {
114 /* The RWPF performs format conversion but can't scale, only the
115 * format code can be changed on the source pad.
117 format
->code
= fmt
->format
.code
;
118 fmt
->format
= *format
;
122 format
->code
= fmt
->format
.code
;
123 format
->width
= clamp_t(unsigned int, fmt
->format
.width
,
124 RWPF_MIN_WIDTH
, rwpf
->max_width
);
125 format
->height
= clamp_t(unsigned int, fmt
->format
.height
,
126 RWPF_MIN_HEIGHT
, rwpf
->max_height
);
127 format
->field
= V4L2_FIELD_NONE
;
128 format
->colorspace
= V4L2_COLORSPACE_SRGB
;
130 fmt
->format
= *format
;
132 /* Update the sink crop rectangle. */
133 crop
= vsp1_rwpf_get_crop(rwpf
, fh
, fmt
->which
);
136 crop
->width
= fmt
->format
.width
;
137 crop
->height
= fmt
->format
.height
;
139 /* Propagate the format to the source pad. */
140 format
= vsp1_entity_get_pad_format(&rwpf
->entity
, fh
, RWPF_PAD_SOURCE
,
142 *format
= fmt
->format
;
147 int vsp1_rwpf_get_selection(struct v4l2_subdev
*subdev
,
148 struct v4l2_subdev_fh
*fh
,
149 struct v4l2_subdev_selection
*sel
)
151 struct vsp1_rwpf
*rwpf
= to_rwpf(subdev
);
152 struct v4l2_mbus_framefmt
*format
;
154 /* Cropping is implemented on the sink pad. */
155 if (sel
->pad
!= RWPF_PAD_SINK
)
158 switch (sel
->target
) {
159 case V4L2_SEL_TGT_CROP
:
160 sel
->r
= *vsp1_rwpf_get_crop(rwpf
, fh
, sel
->which
);
163 case V4L2_SEL_TGT_CROP_BOUNDS
:
164 format
= vsp1_entity_get_pad_format(&rwpf
->entity
, fh
,
165 RWPF_PAD_SINK
, sel
->which
);
168 sel
->r
.width
= format
->width
;
169 sel
->r
.height
= format
->height
;
179 int vsp1_rwpf_set_selection(struct v4l2_subdev
*subdev
,
180 struct v4l2_subdev_fh
*fh
,
181 struct v4l2_subdev_selection
*sel
)
183 struct vsp1_rwpf
*rwpf
= to_rwpf(subdev
);
184 struct v4l2_mbus_framefmt
*format
;
185 struct v4l2_rect
*crop
;
187 /* Cropping is implemented on the sink pad. */
188 if (sel
->pad
!= RWPF_PAD_SINK
)
191 if (sel
->target
!= V4L2_SEL_TGT_CROP
)
194 /* Make sure the crop rectangle is entirely contained in the image. The
195 * WPF top and left offsets are limited to 255.
197 format
= vsp1_entity_get_pad_format(&rwpf
->entity
, fh
, RWPF_PAD_SINK
,
199 sel
->r
.left
= min_t(unsigned int, sel
->r
.left
, format
->width
- 2);
200 sel
->r
.top
= min_t(unsigned int, sel
->r
.top
, format
->height
- 2);
201 if (rwpf
->entity
.type
== VSP1_ENTITY_WPF
) {
202 sel
->r
.left
= min_t(unsigned int, sel
->r
.left
, 255);
203 sel
->r
.top
= min_t(unsigned int, sel
->r
.top
, 255);
205 sel
->r
.width
= min_t(unsigned int, sel
->r
.width
,
206 format
->width
- sel
->r
.left
);
207 sel
->r
.height
= min_t(unsigned int, sel
->r
.height
,
208 format
->height
- sel
->r
.top
);
210 crop
= vsp1_rwpf_get_crop(rwpf
, fh
, sel
->which
);
213 /* Propagate the format to the source pad. */
214 format
= vsp1_entity_get_pad_format(&rwpf
->entity
, fh
, RWPF_PAD_SOURCE
,
216 format
->width
= crop
->width
;
217 format
->height
= crop
->height
;