@@ -88,6 +88,10 @@
#define MIPI_CSIS_INT_MSK_ERR_CRC BIT(1)
#define MIPI_CSIS_INT_MSK_ERR_UNKNOWN BIT(0)
+/* CSIS Interrupt mask 1 */
+#define MIPI_CSIS_INT_MSK_1 0x18
+#define MIPI_CSIS_INT_MSK_1_LINE_END BIT(0)
+
/* CSIS Interrupt source */
#define MIPI_CSIS_INT_SRC 0x14
#define MIPI_CSIS_INT_SRC_EVEN_BEFORE BIT(31)
@@ -109,6 +113,10 @@
#define MIPI_CSIS_INT_SRC_ERR_UNKNOWN BIT(0)
#define MIPI_CSIS_INT_SRC_ERRORS 0xfffff
+/* CSIS Interrupt source 1 */
+#define MIPI_CSIS_INT_SRC_1 0x1c
+#define MIPI_CSIS_INT_SRC_1_LINE_END BIT(0)
+
/* D-PHY status control */
#define MIPI_CSIS_DPHY_STATUS 0x20
#define MIPI_CSIS_DPHY_STATUS_ULPS_DAT BIT(8)
@@ -221,6 +229,7 @@
#define MIPI_CSIS_DBG_INTR_SRC_CAM_VSYNC_RISE BIT(0)
#define MIPI_CSIS_FRAME_COUNTER_CH(n) (0x0100 + (n) * 4)
+#define MIPI_CSIS_LINE_INTERRUPT_RATIO(n) (0x0110 + (n) * 4)
/* Non-image packet data buffers */
#define MIPI_CSIS_PKTDATA_ODD 0x2000
@@ -281,6 +290,8 @@ static const struct mipi_csis_event mipi_csis_events[] = {
{ 0, MIPI_CSIS_INT_SRC_FRAME_END, "Frame End"},
{ 1, MIPI_CSIS_DBG_INTR_SRC_CAM_VSYNC_FALL, "VSYNC Falling Edge"},
{ 1, MIPI_CSIS_DBG_INTR_SRC_CAM_VSYNC_RISE, "VSYNC Rising Edge"},
+ /* User Line interrupt */
+ { 2, MIPI_CSIS_INT_SRC_1_LINE_END, "Line End"}
};
#define MIPI_CSIS_NUM_EVENTS ARRAY_SIZE(mipi_csis_events)
@@ -333,11 +344,14 @@ struct mipi_csis_device {
spinlock_t slock; /* Protect events */
struct mipi_csis_event events[MIPI_CSIS_NUM_EVENTS];
+
struct dentry *debugfs_root;
struct {
bool enable;
u32 hs_settle;
u32 clk_settle;
+ u32 int_line;
+ u32 last_int_line;
} debug;
};
@@ -686,6 +700,15 @@ static void mipi_csis_set_params(struct mipi_csis_device *csis,
MIPI_CSIS_DPHY_BCTRL_L_B_DPHYCTRL(20000000));
mipi_csis_write(csis, MIPI_CSIS_DPHY_BCTRL_H, 0);
+ if (csis->debug.int_line > 0)
+ mipi_csis_write(csis, MIPI_CSIS_LINE_INTERRUPT_RATIO(0),
+ csis->debug.int_line - 1);
+
+ mipi_csis_write(csis, MIPI_CSIS_INT_MSK_1,
+ csis->debug.int_line ?
+ MIPI_CSIS_INT_MSK_1_LINE_END : 0);
+ csis->debug.last_int_line = csis->debug.int_line;
+
/* Update the shadow register. */
val = mipi_csis_read(csis, MIPI_CSIS_CMN_CTRL);
mipi_csis_write(csis, MIPI_CSIS_CMN_CTRL,
@@ -765,10 +788,12 @@ static irqreturn_t mipi_csis_irq_handler(int irq, void *dev_id)
struct mipi_csis_device *csis = dev_id;
unsigned long flags;
unsigned int i;
- u32 status[2];
+ u32 int_lines;
+ u32 status[3];
status[0] = mipi_csis_read(csis, MIPI_CSIS_INT_SRC);
status[1] = mipi_csis_read(csis, MIPI_CSIS_DBG_INTR_SRC);
+ status[2] = mipi_csis_read(csis, MIPI_CSIS_INT_SRC_1);
spin_lock_irqsave(&csis->slock, flags);
@@ -785,10 +810,25 @@ static irqreturn_t mipi_csis_irq_handler(int irq, void *dev_id)
if (status[0] & MIPI_CSIS_INT_SRC_FRAME_START)
mipi_csis_queue_event_sof(csis);
+ int_lines = READ_ONCE(csis->debug.int_line);
+ if (int_lines != csis->debug.last_int_line) {
+ if (int_lines > 0)
+ mipi_csis_write(csis, MIPI_CSIS_LINE_INTERRUPT_RATIO(0),
+ max(int_lines, 1U) - 1);
+ else
+ mipi_csis_write(csis,
+ MIPI_CSIS_LINE_INTERRUPT_RATIO(0), 0);
+
+ csis->debug.last_int_line = int_lines;
+ mipi_csis_write(csis, MIPI_CSIS_INT_MSK_1,
+ int_lines ? MIPI_CSIS_INT_MSK_1_LINE_END : 0);
+ }
+
spin_unlock_irqrestore(&csis->slock, flags);
mipi_csis_write(csis, MIPI_CSIS_INT_SRC, status[0]);
mipi_csis_write(csis, MIPI_CSIS_DBG_INTR_SRC, status[1]);
+ mipi_csis_write(csis, MIPI_CSIS_INT_SRC_1, status[2]);
return IRQ_HANDLED;
}
@@ -928,6 +968,7 @@ static void mipi_csis_debugfs_init(struct mipi_csis_device *csis)
{
csis->debug.hs_settle = UINT_MAX;
csis->debug.clk_settle = UINT_MAX;
+ csis->debug.int_line = 0;
csis->debugfs_root = debugfs_create_dir(dev_name(csis->dev), NULL);
@@ -939,6 +980,8 @@ static void mipi_csis_debugfs_init(struct mipi_csis_device *csis)
&csis->debug.clk_settle);
debugfs_create_u32("ths_settle", 0600, csis->debugfs_root,
&csis->debug.hs_settle);
+ debugfs_create_u32("int_line_0", 0600, csis->debugfs_root,
+ &csis->debug.int_line);
}
static void mipi_csis_debugfs_exit(struct mipi_csis_device *csis)
The NXP i.MX 8M Plus features an interrupt that triggers after the MIPI CSI receiver counts a user-configurable number of lines. This is useful for debugging, as it allows users to check if the amount of lines per frame equals what they are expecting. Add support for this interrupt in the driver, and an entry into debugfs to allow the user to configure whether the interrupt is enabled, as well as the number of lines after which to trigger the interrupt. This debugfs control can be altered while a stream is in progress, with 0 disabling the interrupt and >0 setting a new desired line count. Signed-off-by: Isaac Scott <isaac.scott@ideasonboard.com> --- drivers/media/platform/nxp/imx-mipi-csis.c | 45 +++++++++++++++++++++- 1 file changed, 44 insertions(+), 1 deletion(-)