@@ -400,6 +400,13 @@ struct vsp1_rwpf *vsp1_rpf_create(struct vsp1_device *vsp1, unsigned int index)
rpf->entity.type = VSP1_ENTITY_RPF;
rpf->entity.index = index;
+ ret = vsp1_rwpf_init_formats(vsp1, rpf);
+ if (ret < 0) {
+ dev_err(vsp1->dev, "rpf%u: failed to initialize formats\n",
+ index);
+ return ERR_PTR(ret);
+ }
+
sprintf(name, "rpf.%u", index);
ret = vsp1_entity_init(vsp1, &rpf->entity, name, 2, &vsp1_rwpf_subdev_ops,
MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER);
@@ -16,12 +16,47 @@
#define RWPF_MIN_WIDTH 1
#define RWPF_MIN_HEIGHT 1
+struct vsp1_rwpf_codes {
+ const u32 *codes;
+ unsigned int num_codes;
+};
+
static const u32 rwpf_mbus_codes[] = {
MEDIA_BUS_FMT_ARGB8888_1X32,
MEDIA_BUS_FMT_AHSV8888_1X32,
MEDIA_BUS_FMT_AYUV8_1X32,
};
+static const struct vsp1_rwpf_codes rwpf_codes = {
+ .codes = rwpf_mbus_codes,
+ .num_codes = ARRAY_SIZE(rwpf_mbus_codes),
+};
+
+static const u32 vspx_rpf0_mbus_codes[] = {
+ MEDIA_BUS_FMT_Y8_1X8,
+ MEDIA_BUS_FMT_Y10_1X10,
+ MEDIA_BUS_FMT_Y12_1X12,
+ MEDIA_BUS_FMT_Y16_1X16,
+ MEDIA_BUS_FMT_METADATA_FIXED
+};
+
+static const struct vsp1_rwpf_codes vspx_rpf0_codes = {
+ .codes = vspx_rpf0_mbus_codes,
+ .num_codes = ARRAY_SIZE(vspx_rpf0_mbus_codes),
+};
+
+static const u32 vspx_rpf1_mbus_codes[] = {
+ MEDIA_BUS_FMT_Y8_1X8,
+ MEDIA_BUS_FMT_Y10_1X10,
+ MEDIA_BUS_FMT_Y12_1X12,
+ MEDIA_BUS_FMT_Y16_1X16,
+};
+
+static const struct vsp1_rwpf_codes vspx_rpf1_codes = {
+ .codes = vspx_rpf1_mbus_codes,
+ .num_codes = ARRAY_SIZE(vspx_rpf1_mbus_codes),
+};
+
/* -----------------------------------------------------------------------------
* V4L2 Subdevice Operations
*/
@@ -30,10 +65,12 @@ static int vsp1_rwpf_enum_mbus_code(struct v4l2_subdev *subdev,
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_mbus_code_enum *code)
{
- if (code->index >= ARRAY_SIZE(rwpf_mbus_codes))
+ struct vsp1_rwpf *rwpf = to_rwpf(subdev);
+
+ if (code->index >= rwpf->mbus_codes->num_codes)
return -EINVAL;
- code->code = rwpf_mbus_codes[code->index];
+ code->code = rwpf->mbus_codes->codes[code->index];
return 0;
}
@@ -69,12 +106,12 @@ static int vsp1_rwpf_set_format(struct v4l2_subdev *subdev,
}
/* Default to YUV if the requested format is not supported. */
- for (i = 0; i < ARRAY_SIZE(rwpf_mbus_codes); ++i) {
- if (fmt->format.code == rwpf_mbus_codes[i])
+ for (i = 0; i < rwpf->mbus_codes->num_codes; ++i) {
+ if (fmt->format.code == rwpf->mbus_codes->codes[i])
break;
}
- if (i == ARRAY_SIZE(rwpf_mbus_codes))
- fmt->format.code = MEDIA_BUS_FMT_AYUV8_1X32;
+ if (i == rwpf->mbus_codes->num_codes)
+ fmt->format.code = rwpf->mbus_codes->codes[0];
format = v4l2_subdev_state_get_format(state, fmt->pad);
@@ -267,8 +304,38 @@ static const struct v4l2_ctrl_ops vsp1_rwpf_ctrl_ops = {
.s_ctrl = vsp1_rwpf_s_ctrl,
};
+
+int vsp1_rwpf_init_formats(struct vsp1_device *vsp1, struct vsp1_rwpf *rwpf)
+{
+ /* Only VSPX and RPF support reading Bayer data. */
+ if (!vsp1_feature(vsp1, VSP1_HAS_IIF) ||
+ rwpf->entity.type != VSP1_ENTITY_RPF) {
+ rwpf->mbus_codes = &rwpf_codes;
+ return 0;
+ }
+
+ /*
+ * VSPX only features RPF0 and RPF1. RPF0 supports reading ISP ConfigDMA
+ * and Bayer data, RPF1 supports reading Bayer data only.
+ */
+ switch (rwpf->entity.index) {
+ case 0:
+ rwpf->mbus_codes = &vspx_rpf0_codes;
+ break;
+ case 1:
+ rwpf->mbus_codes = &vspx_rpf1_codes;
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
int vsp1_rwpf_init_ctrls(struct vsp1_rwpf *rwpf, unsigned int ncontrols)
{
+ /* Initialize controls. */
+
v4l2_ctrl_handler_init(&rwpf->ctrls, ncontrols + 1);
v4l2_ctrl_new_std(&rwpf->ctrls, &vsp1_rwpf_ctrl_ops,
V4L2_CID_ALPHA_COMPONENT, 0, 255, 1, 255);
@@ -30,6 +30,7 @@ struct vsp1_rwpf_memory {
dma_addr_t addr[3];
};
+struct vsp1_rwpf_codes;
struct vsp1_rwpf {
struct vsp1_entity entity;
struct v4l2_ctrl_handler ctrls;
@@ -39,6 +40,8 @@ struct vsp1_rwpf {
unsigned int max_width;
unsigned int max_height;
+ const struct vsp1_rwpf_codes *mbus_codes;
+
struct v4l2_pix_format_mplane format;
const struct vsp1_format_info *fmtinfo;
unsigned int brx_input;
@@ -81,6 +84,7 @@ struct vsp1_rwpf *vsp1_wpf_create(struct vsp1_device *vsp1, unsigned int index);
void vsp1_wpf_stop(struct vsp1_rwpf *wpf);
+int vsp1_rwpf_init_formats(struct vsp1_device *vsp1, struct vsp1_rwpf *rwpf);
int vsp1_rwpf_init_ctrls(struct vsp1_rwpf *rwpf, unsigned int ncontrols);
extern const struct v4l2_subdev_ops vsp1_rwpf_subdev_ops;
@@ -548,6 +548,13 @@ struct vsp1_rwpf *vsp1_wpf_create(struct vsp1_device *vsp1, unsigned int index)
wpf->entity.type = VSP1_ENTITY_WPF;
wpf->entity.index = index;
+ ret = vsp1_rwpf_init_formats(vsp1, wpf);
+ if (ret < 0) {
+ dev_err(vsp1->dev, "wpf%u: failed to initialize formats\n",
+ index);
+ return ERR_PTR(ret);
+ }
+
sprintf(name, "wpf.%u", index);
ret = vsp1_entity_init(vsp1, &wpf->entity, name, 2, &vsp1_rwpf_subdev_ops,
MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER);