Commit 2ed38569 authored by Paul Kocialkowski's avatar Paul Kocialkowski Committed by Mauro Carvalho Chehab

media: sun6i-csi: Tidy capture configure code

Some misc code cleanups and preparation for upcoming changes.
Signed-off-by: default avatarPaul Kocialkowski <paul.kocialkowski@bootlin.com>
Acked-by: default avatarJernej Skrabec <jernej.skrabec@gmail.com>
Signed-off-by: default avatarSakari Ailus <sakari.ailus@linux.intel.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@kernel.org>
parent 83b1356b
...@@ -353,133 +353,120 @@ static enum csi_input_seq get_csi_input_seq(struct sun6i_csi_device *csi_dev, ...@@ -353,133 +353,120 @@ static enum csi_input_seq get_csi_input_seq(struct sun6i_csi_device *csi_dev,
static void static void
sun6i_csi_capture_configure_interface(struct sun6i_csi_device *csi_dev) sun6i_csi_capture_configure_interface(struct sun6i_csi_device *csi_dev)
{ {
struct device *dev = csi_dev->dev;
struct regmap *regmap = csi_dev->regmap;
struct v4l2_fwnode_endpoint *endpoint = struct v4l2_fwnode_endpoint *endpoint =
&csi_dev->bridge.source_parallel.endpoint; &csi_dev->bridge.source_parallel.endpoint;
unsigned char bus_width = endpoint->bus.parallel.bus_width;
unsigned int flags = endpoint->bus.parallel.flags;
u32 pixelformat, field; u32 pixelformat, field;
unsigned char bus_width; u32 value = SUN6I_CSI_IF_CFG_IF_CSI;
u32 flags;
u32 cfg = 0;
bool input_interlaced = false;
sun6i_csi_capture_format(csi_dev, &pixelformat, &field); sun6i_csi_capture_format(csi_dev, &pixelformat, &field);
if (field == V4L2_FIELD_INTERLACED || if (field == V4L2_FIELD_INTERLACED ||
field == V4L2_FIELD_INTERLACED_TB || field == V4L2_FIELD_INTERLACED_TB ||
field == V4L2_FIELD_INTERLACED_BT) field == V4L2_FIELD_INTERLACED_BT)
input_interlaced = true; value |= SUN6I_CSI_IF_CFG_SRC_TYPE_INTERLACED |
SUN6I_CSI_IF_CFG_FIELD_DT_PCLK_SHIFT(1) |
bus_width = endpoint->bus.parallel.bus_width; SUN6I_CSI_IF_CFG_FIELD_DT_FIELD_VSYNC;
if (input_interlaced)
cfg |= SUN6I_CSI_IF_CFG_SRC_TYPE_INTERLACED |
SUN6I_CSI_IF_CFG_FIELD_DT_PCLK_SHIFT(1) |
SUN6I_CSI_IF_CFG_FIELD_DT_FIELD_VSYNC;
else else
cfg |= SUN6I_CSI_IF_CFG_SRC_TYPE_PROGRESSIVE; value |= SUN6I_CSI_IF_CFG_SRC_TYPE_PROGRESSIVE;
switch (endpoint->bus_type) { switch (endpoint->bus_type) {
case V4L2_MBUS_PARALLEL: case V4L2_MBUS_PARALLEL:
cfg |= SUN6I_CSI_IF_CFG_IF_CSI;
flags = endpoint->bus.parallel.flags;
if (bus_width == 16) if (bus_width == 16)
cfg |= SUN6I_CSI_IF_CFG_IF_CSI_YUV_COMBINED; value |= SUN6I_CSI_IF_CFG_IF_CSI_YUV_COMBINED;
else else
cfg |= SUN6I_CSI_IF_CFG_IF_CSI_YUV_RAW; value |= SUN6I_CSI_IF_CFG_IF_CSI_YUV_RAW;
if (flags & V4L2_MBUS_FIELD_EVEN_LOW) if (flags & V4L2_MBUS_FIELD_EVEN_LOW)
cfg |= SUN6I_CSI_IF_CFG_FIELD_NEGATIVE; value |= SUN6I_CSI_IF_CFG_FIELD_NEGATIVE;
else else
cfg |= SUN6I_CSI_IF_CFG_FIELD_POSITIVE; value |= SUN6I_CSI_IF_CFG_FIELD_POSITIVE;
if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW)
cfg |= SUN6I_CSI_IF_CFG_VREF_POL_NEGATIVE; value |= SUN6I_CSI_IF_CFG_VREF_POL_NEGATIVE;
else else
cfg |= SUN6I_CSI_IF_CFG_VREF_POL_POSITIVE; value |= SUN6I_CSI_IF_CFG_VREF_POL_POSITIVE;
if (flags & V4L2_MBUS_HSYNC_ACTIVE_LOW) if (flags & V4L2_MBUS_HSYNC_ACTIVE_LOW)
cfg |= SUN6I_CSI_IF_CFG_HREF_POL_NEGATIVE; value |= SUN6I_CSI_IF_CFG_HREF_POL_NEGATIVE;
else else
cfg |= SUN6I_CSI_IF_CFG_HREF_POL_POSITIVE; value |= SUN6I_CSI_IF_CFG_HREF_POL_POSITIVE;
if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING)
cfg |= SUN6I_CSI_IF_CFG_CLK_POL_RISING; value |= SUN6I_CSI_IF_CFG_CLK_POL_RISING;
else else
cfg |= SUN6I_CSI_IF_CFG_CLK_POL_FALLING; value |= SUN6I_CSI_IF_CFG_CLK_POL_FALLING;
break; break;
case V4L2_MBUS_BT656: case V4L2_MBUS_BT656:
cfg |= SUN6I_CSI_IF_CFG_IF_CSI;
flags = endpoint->bus.parallel.flags;
if (bus_width == 16) if (bus_width == 16)
cfg |= SUN6I_CSI_IF_CFG_IF_CSI_BT1120; value |= SUN6I_CSI_IF_CFG_IF_CSI_BT1120;
else else
cfg |= SUN6I_CSI_IF_CFG_IF_CSI_BT656; value |= SUN6I_CSI_IF_CFG_IF_CSI_BT656;
if (flags & V4L2_MBUS_FIELD_EVEN_LOW) if (flags & V4L2_MBUS_FIELD_EVEN_LOW)
cfg |= SUN6I_CSI_IF_CFG_FIELD_NEGATIVE; value |= SUN6I_CSI_IF_CFG_FIELD_NEGATIVE;
else else
cfg |= SUN6I_CSI_IF_CFG_FIELD_POSITIVE; value |= SUN6I_CSI_IF_CFG_FIELD_POSITIVE;
if (flags & V4L2_MBUS_PCLK_SAMPLE_FALLING) if (flags & V4L2_MBUS_PCLK_SAMPLE_FALLING)
cfg |= SUN6I_CSI_IF_CFG_CLK_POL_RISING; value |= SUN6I_CSI_IF_CFG_CLK_POL_RISING;
else else
cfg |= SUN6I_CSI_IF_CFG_CLK_POL_FALLING; value |= SUN6I_CSI_IF_CFG_CLK_POL_FALLING;
break; break;
default: default:
dev_warn(csi_dev->dev, "Unsupported bus type: %d\n", dev_warn(dev, "unsupported bus type: %d\n", endpoint->bus_type);
endpoint->bus_type);
break; break;
} }
switch (bus_width) { switch (bus_width) {
case 8: case 8:
cfg |= SUN6I_CSI_IF_CFG_DATA_WIDTH_8; /* 16-bit YUV formats use a doubled width in 8-bit mode. */
case 16:
value |= SUN6I_CSI_IF_CFG_DATA_WIDTH_8;
break; break;
case 10: case 10:
cfg |= SUN6I_CSI_IF_CFG_DATA_WIDTH_10; value |= SUN6I_CSI_IF_CFG_DATA_WIDTH_10;
break; break;
case 12: case 12:
cfg |= SUN6I_CSI_IF_CFG_DATA_WIDTH_12; value |= SUN6I_CSI_IF_CFG_DATA_WIDTH_12;
break;
case 16: /* No need to configure DATA_WIDTH for 16bit */
break; break;
default: default:
dev_warn(csi_dev->dev, "Unsupported bus width: %u\n", bus_width); dev_warn(dev, "unsupported bus width: %u\n", bus_width);
break; break;
} }
regmap_write(csi_dev->regmap, SUN6I_CSI_IF_CFG_REG, cfg); regmap_write(regmap, SUN6I_CSI_IF_CFG_REG, value);
} }
static void sun6i_csi_capture_configure_format(struct sun6i_csi_device *csi_dev) static void sun6i_csi_capture_configure_format(struct sun6i_csi_device *csi_dev)
{ {
struct regmap *regmap = csi_dev->regmap;
u32 mbus_code, pixelformat, field; u32 mbus_code, pixelformat, field;
u32 cfg = 0; u8 input_format, input_yuv_seq, output_format;
u32 val; u32 value = 0;
sun6i_csi_capture_format(csi_dev, &pixelformat, &field); sun6i_csi_capture_format(csi_dev, &pixelformat, &field);
sun6i_csi_bridge_format(csi_dev, &mbus_code, NULL); sun6i_csi_bridge_format(csi_dev, &mbus_code, NULL);
val = get_csi_input_format(csi_dev, mbus_code, pixelformat); input_format = get_csi_input_format(csi_dev, mbus_code, pixelformat);
cfg |= SUN6I_CSI_CH_CFG_INPUT_FMT(val); input_yuv_seq = get_csi_input_seq(csi_dev, mbus_code, pixelformat);
output_format = get_csi_output_format(csi_dev, pixelformat, field);
val = get_csi_output_format(csi_dev, pixelformat, field);
cfg |= SUN6I_CSI_CH_CFG_OUTPUT_FMT(val);
val = get_csi_input_seq(csi_dev, mbus_code, pixelformat); value |= SUN6I_CSI_CH_CFG_OUTPUT_FMT(output_format);
cfg |= SUN6I_CSI_CH_CFG_INPUT_YUV_SEQ(val); value |= SUN6I_CSI_CH_CFG_INPUT_FMT(input_format);
value |= SUN6I_CSI_CH_CFG_INPUT_YUV_SEQ(input_yuv_seq);
if (field == V4L2_FIELD_TOP) if (field == V4L2_FIELD_TOP)
cfg |= SUN6I_CSI_CH_CFG_FIELD_SEL_FIELD0; value |= SUN6I_CSI_CH_CFG_FIELD_SEL_FIELD0;
else if (field == V4L2_FIELD_BOTTOM) else if (field == V4L2_FIELD_BOTTOM)
cfg |= SUN6I_CSI_CH_CFG_FIELD_SEL_FIELD1; value |= SUN6I_CSI_CH_CFG_FIELD_SEL_FIELD1;
else else
cfg |= SUN6I_CSI_CH_CFG_FIELD_SEL_EITHER; value |= SUN6I_CSI_CH_CFG_FIELD_SEL_EITHER;
regmap_write(csi_dev->regmap, SUN6I_CSI_CH_CFG_REG, cfg); regmap_write(regmap, SUN6I_CSI_CH_CFG_REG, value);
} }
static void sun6i_csi_capture_configure_window(struct sun6i_csi_device *csi_dev) static void sun6i_csi_capture_configure_window(struct sun6i_csi_device *csi_dev)
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment