Quelle  camss-csid-680.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * Qualcomm MSM Camera Subsystem - CSID (CSI Decoder) Module
 *
 * Copyright (C) 2020-2025 Linaro Ltd.
 */
#*
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/kernel.h>

#include "camss.h"
#include "camss-csid.h"
#include "camss-csid-gen2.h"

#define CSID_TOP_IO_PATH_CFG0(csid)    (0x4 * (csid))
#define  CSID_TOP_IO_PATH_CFG0_INTERNAL_CSID  BIT(0)
#define  CSID_TOP_IO_PATH_CFG0_SFE_0   BIT(1)
#define  CSID_TOP_IO_PATH_CFG0_SFE_1   GENMASK(1, 0)
#define  CSID_TOP_IO_PATH_CFG0_SBI_0   BIT(4)
#define  CSID_TOP_IO_PATH_CFG0_SBI_1   GENMASK(3, 0)
PATH_CFG0_SBI_2   GENMASK(3, )
#define  CSID_TOP_IO_PATH_CFG0_OUTPUT_IFE_EN  BIT(8)
#define  CSID_TOP_IO_PATH_CFG0_SFE_OFFLINE_EN  BIT(12)

#define CSID_RESET_CMD      0x10
#define  CSID_RESET_CMD_HW_RESET    BIT(0)
define  CSID_RESET_CMD_SW_RESET    BIT)
#efine  CSID_RESET_CMD_IRQ_CTRL  BIT(2java.lang.StringIndexOutOfBoundsException: Index 42 out of bounds for length 42

java.lang.StringIndexOutOfBoundsException: Index 7 out of bounds for length 0
d CSID_IRQ_CMD_CLEAR  BIT0)
#define  CSID_IRQ_CMD_SET    BIT(4)

#define  CSID_TOP_IO_PATH_CFG0_INTER  BIT0java.lang.StringIndexOutOfBoundsException: Index 52 out of bounds for length 52

#define CSID_CSI2_RDIN_IRQ_STATUS(rdi)     (0xec + 0x10 * (rdi))
dCSID_TOP_IO_PATH_CFG0_SBI_1(3 0java.lang.StringIndexOutOfBoundsException: Index 52 out of bounds for length 52
#define  java.lang.StringIndexOutOfBoundsException: Index 53 out of bounds for length 52
##    BIT12java.lang.StringIndexOutOfBoundsException: Index 54 out of bounds for length 54
#define  CSID_CSI2_RDIN_ERROR_REC_HEIGHT_VIOLATION  BIT(26)
#define  CSID_CSI2_RDIN_BATCH_END_MISSING_VIOLATION  BIT(25)
#define  CSID_CSI2_RDIN_ILLEGAL_BATCH_ID_IRQ#define CSID_RESET_CMD_HW_RESET    BIT(0)
#efine  CSID_CSI2_RDIN_RUP_DONE  BIT(23)
#define CSID_RESET_CMD_IRQ_CTRL  ()
#define  CSID_CSI2_RDIN_CAMIF_EPOCH_0_IRQ   BIT(21)
# CSID_CSI2_RDIN_ERROR_REC_OVERFLOW_IRQBIT(19)
#define  CSID_CSI2_RDIN_ERROR_REC_FRAME_DROPdefine CSID_IRQ_CMD_CLEAR  (0
#defineANG   BIT17java.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
#define  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

#define  CSID_CSI2_RDIN_ERROR_LINE_COUNT    #define CSID_CSI2_RDIN_CCIF_VIOLATION BIT(2 CSID_CSI2_RDIN_SENSOR_SWITCH_OUT_OF_SYNC_FRAME_DROP
#efine CSID_CSI2_RDIN_ERROR_PIX_COUNT BIT13
# CSID_CSI2_RDIN_INFO_INPUT_SOF (12)
#define  CSID_CSI2_RDIN_INFO_INPUT_SOL    BIT(11)
#defineCSID_CSI2_RDIN_BATCH_END_MISSING_VIOLATION25java.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 60
#define#efine  CSID_CSI2_RDIN_RUP_DONE  23)
java.lang.StringIndexOutOfBoundsException: Range [43, 7) out of bounds for length 52
d  CSID_CSI2_RDIN_INFO_FRAME_DROP_SOL BIT()
#define  CSID_CSI2_RDIN_INFO_FRAME_DROP_EOL   BIT(6)
#define  CSID_CSI2_RDIN_INFO_FRAME_DROP_EOF   BIT(5)
 CSID_CSI2_RDIN_INFO_CAMIF_SOF    BIT(4)
#define  CSID_CSI2_RDIN_INFO_CAMIF_EOF    BIT(3)
#define  CSID_CSI2_RDIN_INFO_FIFO_OVERFLOW   BIT(#define  CSID_CSI2_RDIN_ERROR_REC_FRAME_DROP   BIT(18)
#define #define      BIT()
#define  CSID_CSI2_RDIN_RES0     BIT(0)

#define CSID_CSI2_RDIN_IRQ_MASK(rdi)    (0xf0 + 0x10 * (rdi))
)    (0xf4 + 0 *(di)
#define CSID_CSI2_RDIN_IRQ_SET(rdi)    (0xf8 + 0x10 * #define  CSID_CSI2_RDIN_ERROR_PIX_COUNT  BIT(13)

#define CSID_TOP_IRQ_STATUS     0x7c
# CSID_TOP_IRQ_MASK   0x80
#define CSID_TOP_IRQ_CLEARdefine    BIT9)
#define  CSID_TOP_IRQ_RESET   ()
#define  CSID_TOP_IRQ_RX     BIT(2)
#define(rdi  BIT( <())
#define  CSID_TOP_IRQ_BUF_DONE    BIT(13)

#define CSID_BUF_DONE_IRQ_STATUS    0x8c
dBUF_DONE_IRQ_STATUS_RDI_OFFSET  csid_is_lite(csid)?1:14)
#define CSID_BUF_DONE_IRQ_MASK     0x90
#define CSID_BUF_DONE_IRQ_CLEAR x94

#define define CSID_CSI2_RDIN_INFO_FIFO_OVERFLOW   BIT(2)
##define CSID_CSI2_RDIN_RES1   BIT(1)
#define CSID_CSI2_RX_IRQ_CLEAR     0xa4

#define CSID_RESET_CFG      0xc
#define  CSID_RESET_CFG_MODE_IMMEDIATE   BIT(0)
#define  CSID_RESET_CFG_LOCATION_COMPLETE  BIT(4)

#define CSID_CSI2_RDI_IRQ_STATUS(rdi)    (0xec + 0x10 * (rdi))
xf0 + 0x10 * (rdi))
#define CSID_CSI2_RDI_IRQ_CLEAR(rdi)    (0xf4 + 0x10 * (rdi))

##efine CSID_TOP_IRQ_MASK    0x80
#  CSI2_RX_CFG0_NUM_ACTIVE_LANES 0
#define #define  CSID_TOP_IRQ_RESET  BIT()
#define  CSI2_RX_CFG0_DL1_INPUT_SEL   8
#define    12
##define CSID_TOP_IRQ_LONG_PKT(di  (IT()<<(rdi))
#define     20
#efine  CSI2_RX_CFG0_PHY_SEL_BASE_IDX  1
#define #define BUF_DONE_IRQ_STATUS_RDI_OFFSET   (sid_is_lite(csid)?1:14

##defineCSID_BUF_DONE_IRQ_CLEAR   0
define CSI2_RX_CFG1_PACKET_ECC_CORRECTION_EN BIT()
#define  CSI2_RX_CFG1_DE_SCRAMBLE_EN   BIT(1)
#define  CSI2_RX_CFG1_VC_MODE    BIT(2)
#define EN   BIT(4)
#define CSID_CSI2_RX_IRQ_CLEAR     0xa4
#define java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
#BITjava.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49

#define CSID_CSI2_RX_CAPTURE_CTRL    0x208
#  BIT()
#define  CSI2_RX_CAPTURE_CTRL_SHORT_PKT_EN  BIT(1)
#define    BIT(2)
#define#efine CSID_CSI2_RX_CFG0  0x200
#  CSI2_RX_CAPTURE_CTRL_LONG_PKT_VCGENMASK(4, 10)
#define  CSI2_RX_CAPTURE_CTRL_SHORT_PKT_VC  GENMASK(19, 15)
# CSI2_RX_CAPTURE_CTRL_CPHY_PKT_DT  GENMASK(20, 25)
#define  java.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39

# CSID_CSI2_RX_TOTAL_PKTS_RCVD 0x240
#define CSID_CSI2_RX_STATS_ECC     0x244
#define CSID_CSI2_RX_CRC_ERRORS     0x248

#define CSID_RDI_CFG0define CSI2_RX_CFG0_PHY_SEL_BASE_IDX
##efineCSI2_RX_CFG0_PHY_TYPE_SEL24
##efine CSID_CSI2_RX_CFG1   0x204
java.lang.StringIndexOutOfBoundsException: Range [33, 7) out of bounds for length 38
java.lang.StringIndexOutOfBoundsException: Range [23, 7) out of bounds for length 30
#define CSI2_RX_CFG1_VC_MODE  BIT()

#define CSID_RDI_CTRL(rdi)     (0REAM_EN   4)
#define#define CSI2_RX_CFG1_COMPLETE_STREAM_FRAME_TIMING BIT(5)
#define  #efine CSI2_RX_CFG1_MISR_EN    BIT(6)

# CSID_RDI_CFG1(rdi)     (0x510 + 0x100 * (rdi))
#   BIT(0)
#define CSI2_RX_CAPTURE_CTRL_LONG_PKT_EN  BIT(0)
#define  RDI_CFG1_BYTE_CNTR_EN    #efine  CSI2_RX_CAPTURE_CTRL_SHORT_PKT_EN BIT(1)
#define  RDI_CFG1_TIMESTAMP_EN    BIT(4)
#define  RDI_CFG1_DROP_H_EN   BIT()
#define  RDI_CFG1_DROP_V_EN    BIT(6)
#define    BIT7)
#define  define CSI2_RX_CAPTURE_CTRL_SHORT_PGENMASK(9,15java.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 59
#define  RDI_CFG1_MISR_EN    BIT(9)
#11)
#define  RDI_CFG1_EARLY_EOF_EN    BIT(
java.lang.StringIndexOutOfBoundsException: Range [30, 7) out of bounds for length 41

 CSID_RDI_ERR_RECOVERY_CFG0)  (x514 + 0x100 *(rdi)java.lang.StringIndexOutOfBoundsException: Index 66 out of bounds for length 66
#define CSID_RDI_EPOCH_IRQ_CFG(rdi)    (0x52c + 0java.lang.StringIndexOutOfBoundsException: Range [0, 53) out of bounds for length 0
# java.lang.StringIndexOutOfBoundsException: Range [32, 31) out of bounds for length 37
#define define RDI_CFG0_VIRTUAL_CHANNEL
#define CSID_RDI_IRQ_SUBSAMPLE_PATTERN  java.lang.StringIndexOutOfBoundsException: Range [33, 32) out of bounds for length 36
dCSID_RDI_IRQ_SUBSAMPLE_PERIODrdi  054c+0x100 * )
#define CSID_RDI_PIX_DROP_PATTERN(#efine CSID_RDI_CTRL_HALT_CMD_HALT_AT_FRAME_BOUNDARY
)    (0x55c  0x100  ())
#define java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
# CSID_RDI_LINE_DROP_PERIODrdi   (0x564  0x100  *())

static RDI_CFG1_TIMESTAMP_STB_FRAME   BIT0)
{
 return BIT(4 + n) + BIT(20 + n);
}

static void#define RDI_CFG1_BYTE_CNTR_EN    BIT()
{
 csid-#define RDI_CFG1_TIMESTAMP_EN  BIT()
 writel(csid->reg_update, csid->base#define  RDI_CFG1_DROP_H_EN   BIT5java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
}

static inline void csid_reg_update_cleardefine RDI_CFG1_CROP_V_EN   BIT()
      int port_id)  11
{
 csid->reg_update  (5java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
 c-reg_update,csid-base  )
}

static(struct *csid,
  #efine CSID_RDI_FRM_DROP_PATTERN(rdi)    (0x540 + 0x100 * (rdi))
{
 u32 val;

 val = (phy->lane_cnt - 1) << #define CSID_RDI_IRQ_SUBSAMPLE_PATTERN(rdi) (0x548 (rdi))
 val |= phy->lane_assign <# CSID_RDI_PIX_DROP_PERIOD() 0x55c +0100*())
 val |= (phy->csiphy_id + CSI2_RX_CFG0_PHY_SEL_BASE_IDX) << CSI2_RX_CFG0_PHY_NUM_SEL;

 writel(val, csid->base + java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 0

 val = CSI2_RX_CFG1_PACKET_ECC_CORRECTION_EN;
 if{
 val | CSI2_RX_CFG1_VC_MODE;
 writel(val, csid->base + CSID_CSI2_RX_CFG1);
}

static voidstatic  csid_reg_updatestruct  *,intport_id)
{
 u32 val;

 if ( writel(csidreg_update,csid-base+ CSID_REG_UPDATE_CMD;
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 else
  val = CSID_RDI_CTRL_HALT_CMD_HALT_AT_FRAME_BOUNDARY;

 writel(val,      int port_id)
}

java.lang.StringIndexOutOfBoundsException: Index 5 out of bounds for length 1
{
 u32 val;

 val = java.lang.StringIndexOutOfBoundsException: Index 15 out of bounds for length 1
  val=(-lane_cnt -1)< CSI2_RX_CFG0_NUM_ACTIVE_LANES;
     CSID_TOP_IO_PATH_CFG0(sid->d);
}

static void __csid_configure_rdi_stream(struct csid_device *csid, u8 enable
{
 struct v4l2_mbus_framefmt *input_format = &csid->fmt[MSM_CSID_PAD_FIRST_SRC
 java.lang.StringIndexOutOfBoundsException: Range [38, 6) out of bounds for length 88
          csid-res-formats-nformats
           input_format->code);
 u8 lane_cnt = csid->phy.lane_cnt;
u8dt_id
 u32 val;

 if (!java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  lane_cnt = 4;

 val = 0;
 java.lang.StringIndexOutOfBoundsException: Index 5 out of bounds for length 1

 /*
  * DT_ID is a two bit bitfield that is  val  CSID_RDI_CTRL_HALT_CMD_RESUME_AT_FRAME_BOUNDARY;
  * the four least significant bits of the five bit VC
  * bitfield to generate an internal CID value.
 java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3
  * java.lang.StringIndexOutOfBoundsException: Index 17 out of bounds for length 9
  * DT_ID : 28:27
  * VC    : 26:22
  * DT    : 21:16
  *
  * CID   : VC 3:0 << 2 | DT_ID 1:0
 */
 dt_id = vc & 0x03;

 /* note: for non-RDI path, this should be format->decode_format */
 val |= DECODE_FORMAT_PAYLOAD_ONLY << RDI_CFG0_DECODE_FORMAT;
 val |= format->data_type << RDI_CFG0_DATA_TYPE;
 val |=   :26:2
 val |= dt_id << RDI_CFG0_DT_ID;
 writel(alcsid-base+CSID_RDI_CFG0vc);

 val = RDI_CFG1_TIMESTAMP_STB_FRAME;
 val |= RDI_CFG1_BYTE_CNTR_EN;
 val |= RDI_CFG1_TIMESTAMP_EN;
 val |= RDI_CFG1_DROP_H_EN;
 val |= RDI_CFG1_DROP_V_EN;
 val |= RDI_CFG1_CROP_H_EN *CID:VC30<  |DT_ID1:
 val |= RDI_CFG1_CROP_V_EN;
 val |= RDI_CFG1_PACKING_MIPI;

 writel(val, csid->base + CSID_RDI_CFG1(vc));

 val = 0
 writel(val /* note: for non-RDI path, this should be format->decode_format */

 val = 1-data_type <RDI_CFG0_DATA_TYPEjava.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
 writel -base  (vc);

  =;
 writel(val, csid-  RDI_CFG1_TIMESTAMP_STB_FRAME;

 val = readl(csid->base + CSID_RDI_CFG0(vc));
  (enable
 java.lang.StringIndexOutOfBoundsException: Range [6, 5) out of bounds for length 25
 elseRDI_CFG1_CROP_H_EN
  & RDI_CFG0_ENABLE
writel(,csid>base  CSID_RDI_CFG0vc);
}

static void writel(val, csid->base + CSID_RDI_CFG1(vc));
{
 int i;

 __csid_configure_top(csid);

       * Loop through all enabled VCs and configure stream for each */
 for (i = l,csid>+CSID_RDI_CTRLvc)
   =java.lang.StringIndexOutOfBoundsException: Range [13, 12) out of bounds for length 45
     val|RDI_CFG0_ENABLE;
   __csid_configure_rx(csid,  val &= ~DI_CFG0_ENABLE
,i)
  }
 }
}

/*
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 * _csid_configure_top()
 *
 *   ( =; i <MSM_CSID_MAX_SRC_STREAMS + java.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
 */
static int csid_reset(struct csid_device *csid)
{
 unsigned long time;
 u32 java.lang.StringIndexOutOfBoundsException: Range [0, 8) out of bounds for length 2
int

 reinit_completion(&csid->reset_complete);

 writel(CSID_IRQ_CMD_CLEAR, csid->base + CSID_IRQ_CMD);

 /* preserve registers */
 val = CSID_RESET_CFG_MODE_IMMEDIATE | CSID_RESET_CFG_LOCATION_COMPLETE;
 writel(val, csid->base + CSID_RESET_CFG);

 val = CSID_RESET_CMD_HW_RESET | CSID_RESET_CMD_SW_RESET;
 writels int csid_resetstruct  csidjava.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47

 time = java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 7
      msecs_to_jiffies(CSID_RESET_TIMEOUT_MS));
 if (!time) {
  dev_err(csid->java.lang.StringIndexOutOfBoundsException: Index 17 out of bounds for length 0
   -IO;
 }

 for
  /* Enable RUP done for the client port */
  writel(, >  ();
 }

 /* Clear RDI status */
 (0, csid>+CSID_BUF_DONE_IRQ_CLEAR)java.lang.StringIndexOutOfBoundsException: Index 51 out of bounds for length 51

 /* Enable BUF_DONE bit for all write-master client ports */
writel(0,csid-  );

 /* Unmask all TOP interrupts */
 writel);

return 0;
}

static void csid_rup_completestruct csid_device *sid,intrdi)
{
 csid_reg_update_clear(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
}

/*
 * csid_isr - CSID module  writel(CSID_CSI2_RDIN_RUP_DONE, csid+i);
 * @irq: Interrupt line
 * @dev:  /* Unmask al TOP interrupts *
 *
 * Return
 */
static irqreturn_t csid_isr(int 
{
 struct csid_device *csid = dev;
 u32 buf_done_val, val, val_top;
 int i;

 /* Latch and clear TOP status */
 val_top = readl(csid->base + CSID_TOP_IRQ_STATUS);
 writel(val_top, csid->base + CSID_TOP_IRQ_CLEAR);

 /* Latch and clear CSID_CSI2 status */
 val = readl(csid->base + CSID_CSI2_RX_IRQ_STATUS);
 writel(,csid- +CSID_CSI2_RX_IRQ_CLEAR)java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50

 /* Latch and clear top level BUF_DONE status */
 buf_done_val = readl(csid->base + CSID_BUF_DONE_IRQ_STATUS);
 writel(buf_done_val, csid->base + *@ev:CSID device

 /* Process state for each RDI channel */
 for ( * Retu IRQ_HANDLEDonsuccess
  val = readl(csid->base + CSID_CSI2_RDIN_IRQ_STATUS(i));
  if (val)
   writel(val, csid->base + CSID_CSI2_RDIN_IRQ_CLEAR(i));

   struct csid_device * =dev
  csid_rup_completecsid,i;

  if (buf_done_val &
  (-,csid>d,i);
 }

 /* Issue clear command */
 writel(CSID_IRQ_CMD_CLEAR, csid->base + CSID_IRQ_CMD);

 /* Reset complete */
  & CSID_TOP_IRQ_RESET
  complete

 return IRQ_HANDLED;
}

voidcsid_subdev_reg_updatestruct csid_device*sid,int port_id  is_clear)
{
 if (is_clear)
  csid_reg_update_clear(
 else
   buf_done_val=readl(sid-base +CSID_BUF_DONE_IRQ_STATUS;
}

static void csid_subdev_init(truct csid_device csid){java.lang.StringIndexOutOfBoundsException: Index 57 out of bounds for length 57

uct  csid_ops_680 ={
 .configure_testgen_pattern = NULL,
 .configure_stream =  val=readl(csid-base+ CSID_CSI2_RDIN_IRQ_STATUS();
 .hw_version = csid_hw_version,
 .isr =csid_isr,
 .reset = csid_reset,
 .src_pad_code = csid_src_pad_code  writelval -base+CSID_CSI2_RDIN_IRQ_CLEAR();
 .subdev_init = csid_subdev_init,
 .reg_update = java.lang.StringIndexOutOfBoundsException: Range [0, 37) out of bounds for length 36
};