Skip to content

L
linux
Commit 97059524 authored by Laurent Pinchart's avatar Laurent Pinchart Committed by Mauro Carvalho Chehab
Browse files
Options

[media] v4l: omap4iss: csi: Create and use register access functions 

Replace the direct readl/writel calls with helper functions.
Signed-off-by: default avatarLaurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: default avatarMauro Carvalho Chehab <m.chehab@samsung.com>
parent 11abbfd3
Hide whitespace changes
Inline Side-by-side
Showing with 76 additions and 85 deletions
drivers/staging/media/omap4iss/iss_csi2.c
View file @ 97059524
...@@ -29,9 +29,8 @@ static void csi2_if_enable(struct iss_csi2_device *csi2, u8 enable) ...@@ -29,9 +29,8 @@ static void csi2_if_enable(struct iss_csi2_device *csi2, u8 enable)
{ {
struct iss_csi2_ctrl_cfg *currctrl = &csi2->ctrl; struct iss_csi2_ctrl_cfg *currctrl = &csi2->ctrl;
writel((readl(csi2->regs1 + CSI2_CTRL) & ~CSI2_CTRL_IF_EN) | iss_reg_update(csi2->iss, csi2->regs1, CSI2_CTRL, CSI2_CTRL_IF_EN,
(enable ? CSI2_CTRL_IF_EN : 0), enable ? CSI2_CTRL_IF_EN : 0);
csi2->regs1 + CSI2_CTRL);
currctrl->if_enable = enable; currctrl->if_enable = enable;
} }
...@@ -90,7 +89,7 @@ static void csi2_recv_config(struct iss_csi2_device *csi2, ...@@ -90,7 +89,7 @@ static void csi2_recv_config(struct iss_csi2_device *csi2,
*/ */
reg |= CSI2_CTRL_ENDIANNESS; reg |= CSI2_CTRL_ENDIANNESS;
writel(reg, csi2->regs1 + CSI2_CTRL); iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTRL, reg);
} }
static const unsigned int csi2_input_fmts[] = { static const unsigned int csi2_input_fmts[] = {
...@@ -260,10 +259,10 @@ static void csi2_set_outaddr(struct iss_csi2_device *csi2, u32 addr) ...@@ -260,10 +259,10 @@ static void csi2_set_outaddr(struct iss_csi2_device *csi2, u32 addr)
ctx->ping_addr = addr; ctx->ping_addr = addr;
ctx->pong_addr = addr; ctx->pong_addr = addr;
writel(ctx->ping_addr, iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_PING_ADDR(ctx->ctxnum),
csi2->regs1 + CSI2_CTX_PING_ADDR(ctx->ctxnum)); ctx->ping_addr);
writel(ctx->pong_addr, iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_PONG_ADDR(ctx->ctxnum),
csi2->regs1 + CSI2_CTX_PONG_ADDR(ctx->ctxnum)); ctx->pong_addr);
} }
/* /*
...@@ -288,7 +287,7 @@ static void csi2_ctx_enable(struct iss_csi2_device *csi2, u8 ctxnum, u8 enable) ...@@ -288,7 +287,7 @@ static void csi2_ctx_enable(struct iss_csi2_device *csi2, u8 ctxnum, u8 enable)
struct iss_csi2_ctx_cfg *ctx = &csi2->contexts[ctxnum]; struct iss_csi2_ctx_cfg *ctx = &csi2->contexts[ctxnum];
u32 reg; u32 reg;
reg = readl(csi2->regs1 + CSI2_CTX_CTRL1(ctxnum)); reg = iss_reg_read(csi2->iss, csi2->regs1, CSI2_CTX_CTRL1(ctxnum));
if (enable) { if (enable) {
unsigned int skip = 0; unsigned int skip = 0;
...@@ -306,7 +305,7 @@ static void csi2_ctx_enable(struct iss_csi2_device *csi2, u8 ctxnum, u8 enable) ...@@ -306,7 +305,7 @@ static void csi2_ctx_enable(struct iss_csi2_device *csi2, u8 ctxnum, u8 enable)
reg &= ~CSI2_CTX_CTRL1_CTX_EN; reg &= ~CSI2_CTX_CTRL1_CTX_EN;
} }
writel(reg, csi2->regs1 + CSI2_CTX_CTRL1(ctxnum)); iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_CTRL1(ctxnum), reg);
ctx->enabled = enable; ctx->enabled = enable;
} }
...@@ -330,7 +329,7 @@ static void csi2_ctx_config(struct iss_csi2_device *csi2, ...@@ -330,7 +329,7 @@ static void csi2_ctx_config(struct iss_csi2_device *csi2,
if (ctx->checksum_enabled) if (ctx->checksum_enabled)
reg |= CSI2_CTX_CTRL1_CS_EN; reg |= CSI2_CTX_CTRL1_CS_EN;
writel(reg, csi2->regs1 + CSI2_CTX_CTRL1(ctx->ctxnum)); iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_CTRL1(ctx->ctxnum), reg);
/* Set up CSI2_CTx_CTRL2 */ /* Set up CSI2_CTx_CTRL2 */
reg = ctx->virtual_id << CSI2_CTX_CTRL2_VIRTUAL_ID_SHIFT; reg = ctx->virtual_id << CSI2_CTX_CTRL2_VIRTUAL_ID_SHIFT;
...@@ -342,23 +341,20 @@ static void csi2_ctx_config(struct iss_csi2_device *csi2, ...@@ -342,23 +341,20 @@ static void csi2_ctx_config(struct iss_csi2_device *csi2,
if (is_usr_def_mapping(ctx->format_id)) if (is_usr_def_mapping(ctx->format_id))
reg |= 2 << CSI2_CTX_CTRL2_USER_DEF_MAP_SHIFT; reg |= 2 << CSI2_CTX_CTRL2_USER_DEF_MAP_SHIFT;
writel(reg, csi2->regs1 + CSI2_CTX_CTRL2(ctx->ctxnum)); iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_CTRL2(ctx->ctxnum), reg);
/* Set up CSI2_CTx_CTRL3 */ /* Set up CSI2_CTx_CTRL3 */
writel(ctx->alpha << CSI2_CTX_CTRL3_ALPHA_SHIFT, iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_CTRL3(ctx->ctxnum),
csi2->regs1 + CSI2_CTX_CTRL3(ctx->ctxnum)); ctx->alpha << CSI2_CTX_CTRL3_ALPHA_SHIFT);
/* Set up CSI2_CTx_DAT_OFST */ /* Set up CSI2_CTx_DAT_OFST */
reg = readl(csi2->regs1 + CSI2_CTX_DAT_OFST(ctx->ctxnum)); iss_reg_update(csi2->iss, csi2->regs1, CSI2_CTX_DAT_OFST(ctx->ctxnum),
reg &= ~CSI2_CTX_DAT_OFST_MASK; CSI2_CTX_DAT_OFST_MASK, ctx->data_offset);
reg |= ctx->data_offset;
writel(reg, csi2->regs1 + CSI2_CTX_DAT_OFST(ctx->ctxnum));
writel(ctx->ping_addr, iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_PING_ADDR(ctx->ctxnum),
csi2->regs1 + CSI2_CTX_PING_ADDR(ctx->ctxnum)); ctx->ping_addr);
iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_PONG_ADDR(ctx->ctxnum),
writel(ctx->pong_addr, ctx->pong_addr);
csi2->regs1 + CSI2_CTX_PONG_ADDR(ctx->ctxnum));
} }
/* /*
...@@ -370,7 +366,7 @@ static void csi2_timing_config(struct iss_csi2_device *csi2, ...@@ -370,7 +366,7 @@ static void csi2_timing_config(struct iss_csi2_device *csi2,
{ {
u32 reg; u32 reg;
reg = readl(csi2->regs1 + CSI2_TIMING); reg = iss_reg_read(csi2->iss, csi2->regs1, CSI2_TIMING);
if (timing->force_rx_mode) if (timing->force_rx_mode)
reg |= CSI2_TIMING_FORCE_RX_MODE_IO1; reg |= CSI2_TIMING_FORCE_RX_MODE_IO1;
...@@ -391,7 +387,7 @@ static void csi2_timing_config(struct iss_csi2_device *csi2, ...@@ -391,7 +387,7 @@ static void csi2_timing_config(struct iss_csi2_device *csi2,
reg |= timing->stop_state_counter << reg |= timing->stop_state_counter <<
CSI2_TIMING_STOP_STATE_COUNTER_IO1_SHIFT; CSI2_TIMING_STOP_STATE_COUNTER_IO1_SHIFT;
writel(reg, csi2->regs1 + CSI2_TIMING); iss_reg_write(csi2->iss, csi2->regs1, CSI2_TIMING, reg);
} }
/* /*
...@@ -407,14 +403,14 @@ static void csi2_irq_ctx_set(struct iss_csi2_device *csi2, int enable) ...@@ -407,14 +403,14 @@ static void csi2_irq_ctx_set(struct iss_csi2_device *csi2, int enable)
reg |= CSI2_CTX_IRQ_FS; reg |= CSI2_CTX_IRQ_FS;
for (i = 0; i < 8; i++) { for (i = 0; i < 8; i++) {
writel(reg, csi2->regs1 + CSI2_CTX_IRQSTATUS(i)); iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_IRQSTATUS(i),
reg);
if (enable) if (enable)
writel(readl(csi2->regs1 + CSI2_CTX_IRQENABLE(i)) | reg, iss_reg_set(csi2->iss, csi2->regs1,
csi2->regs1 + CSI2_CTX_IRQENABLE(i)); CSI2_CTX_IRQENABLE(i), reg);
else else
writel(readl(csi2->regs1 + CSI2_CTX_IRQENABLE(i)) & iss_reg_clr(csi2->iss, csi2->regs1,
~reg, CSI2_CTX_IRQENABLE(i), reg);
csi2->regs1 + CSI2_CTX_IRQENABLE(i));
} }
} }
...@@ -452,12 +448,13 @@ static void csi2_irq_complexio1_set(struct iss_csi2_device *csi2, int enable) ...@@ -452,12 +448,13 @@ static void csi2_irq_complexio1_set(struct iss_csi2_device *csi2, int enable)
CSI2_COMPLEXIO_IRQ_ERRESC1 | CSI2_COMPLEXIO_IRQ_ERRESC1 |
CSI2_COMPLEXIO_IRQ_ERRSOTSYNCHS1 | CSI2_COMPLEXIO_IRQ_ERRSOTSYNCHS1 |
CSI2_COMPLEXIO_IRQ_ERRSOTHS1; CSI2_COMPLEXIO_IRQ_ERRSOTHS1;
writel(reg, csi2->regs1 + CSI2_COMPLEXIO_IRQSTATUS); iss_reg_write(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_IRQSTATUS, reg);
if (enable) if (enable)
reg |= readl(csi2->regs1 + CSI2_COMPLEXIO_IRQENABLE); iss_reg_set(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_IRQENABLE,
reg);
else else
reg = 0; iss_reg_write(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_IRQENABLE,
writel(reg, csi2->regs1 + CSI2_COMPLEXIO_IRQENABLE); 0);
} }
/* /*
...@@ -474,13 +471,11 @@ static void csi2_irq_status_set(struct iss_csi2_device *csi2, int enable) ...@@ -474,13 +471,11 @@ static void csi2_irq_status_set(struct iss_csi2_device *csi2, int enable)
CSI2_IRQ_COMPLEXIO_ERR | CSI2_IRQ_COMPLEXIO_ERR |
CSI2_IRQ_FIFO_OVF | CSI2_IRQ_FIFO_OVF |
CSI2_IRQ_CONTEXT0; CSI2_IRQ_CONTEXT0;
writel(reg, csi2->regs1 + CSI2_IRQSTATUS); iss_reg_write(csi2->iss, csi2->regs1, CSI2_IRQSTATUS, reg);
if (enable) if (enable)
reg |= readl(csi2->regs1 + CSI2_IRQENABLE); iss_reg_set(csi2->iss, csi2->regs1, CSI2_IRQENABLE, reg);
else else
reg = 0; iss_reg_write(csi2->iss, csi2->regs1, CSI2_IRQENABLE, 0);
writel(reg, csi2->regs1 + CSI2_IRQENABLE);
} }
/* /*
...@@ -502,13 +497,12 @@ int omap4iss_csi2_reset(struct iss_csi2_device *csi2) ...@@ -502,13 +497,12 @@ int omap4iss_csi2_reset(struct iss_csi2_device *csi2)
if (csi2->phy->phy_in_use) if (csi2->phy->phy_in_use)
return -EBUSY; return -EBUSY;
writel(readl(csi2->regs1 + CSI2_SYSCONFIG) | iss_reg_set(csi2->iss, csi2->regs1, CSI2_SYSCONFIG,
CSI2_SYSCONFIG_SOFT_RESET, CSI2_SYSCONFIG_SOFT_RESET);
csi2->regs1 + CSI2_SYSCONFIG);
do { do {
reg = readl(csi2->regs1 + CSI2_SYSSTATUS) & reg = iss_reg_read(csi2->iss, csi2->regs1, CSI2_SYSSTATUS)
CSI2_SYSSTATUS_RESET_DONE; & CSI2_SYSSTATUS_RESET_DONE;
if (reg == CSI2_SYSSTATUS_RESET_DONE) if (reg == CSI2_SYSSTATUS_RESET_DONE)
break; break;
soft_reset_retries++; soft_reset_retries++;
...@@ -522,13 +516,12 @@ int omap4iss_csi2_reset(struct iss_csi2_device *csi2) ...@@ -522,13 +516,12 @@ int omap4iss_csi2_reset(struct iss_csi2_device *csi2)
return -EBUSY; return -EBUSY;
} }
writel(readl(csi2->regs1 + CSI2_COMPLEXIO_CFG) | iss_reg_set(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_CFG,
CSI2_COMPLEXIO_CFG_RESET_CTRL, CSI2_COMPLEXIO_CFG_RESET_CTRL);
csi2->regs1 + CSI2_COMPLEXIO_CFG);
i = 100; i = 100;
do { do {
reg = readl(csi2->phy->phy_regs + REGISTER1) reg = iss_reg_read(csi2->iss, csi2->phy->phy_regs, REGISTER1)
& REGISTER1_RESET_DONE_CTRLCLK; & REGISTER1_RESET_DONE_CTRLCLK;
if (reg == REGISTER1_RESET_DONE_CTRLCLK) if (reg == REGISTER1_RESET_DONE_CTRLCLK)
break; break;
...@@ -541,11 +534,10 @@ int omap4iss_csi2_reset(struct iss_csi2_device *csi2) ...@@ -541,11 +534,10 @@ int omap4iss_csi2_reset(struct iss_csi2_device *csi2)
return -EBUSY; return -EBUSY;
} }
writel((readl(csi2->regs1 + CSI2_SYSCONFIG) & iss_reg_update(csi2->iss, csi2->regs1, CSI2_SYSCONFIG,
~(CSI2_SYSCONFIG_MSTANDBY_MODE_MASK | CSI2_SYSCONFIG_MSTANDBY_MODE_MASK |
CSI2_SYSCONFIG_AUTO_IDLE)) | CSI2_SYSCONFIG_AUTO_IDLE,
CSI2_SYSCONFIG_MSTANDBY_MODE_NO, CSI2_SYSCONFIG_MSTANDBY_MODE_NO);
csi2->regs1 + CSI2_SYSCONFIG);
return 0; return 0;
} }
...@@ -627,7 +619,7 @@ static int csi2_configure(struct iss_csi2_device *csi2) ...@@ -627,7 +619,7 @@ static int csi2_configure(struct iss_csi2_device *csi2)
*/ */
#define CSI2_PRINT_REGISTER(iss, regs, name)\ #define CSI2_PRINT_REGISTER(iss, regs, name)\
dev_dbg(iss->dev, "###CSI2 " #name "=0x%08x\n", \ dev_dbg(iss->dev, "###CSI2 " #name "=0x%08x\n", \
readl(regs + CSI2_##name)) iss_reg_read(iss, regs, CSI2_##name))
static void csi2_print_status(struct iss_csi2_device *csi2) static void csi2_print_status(struct iss_csi2_device *csi2)
{ {
...@@ -695,8 +687,8 @@ static void csi2_isr_ctx(struct iss_csi2_device *csi2, ...@@ -695,8 +687,8 @@ static void csi2_isr_ctx(struct iss_csi2_device *csi2,
unsigned int n = ctx->ctxnum; unsigned int n = ctx->ctxnum;
u32 status; u32 status;
status = readl(csi2->regs1 + CSI2_CTX_IRQSTATUS(n)); status = iss_reg_read(csi2->iss, csi2->regs1, CSI2_CTX_IRQSTATUS(n));
writel(status, csi2->regs1 + CSI2_CTX_IRQSTATUS(n)); iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_IRQSTATUS(n), status);
/* Propagate frame number */ /* Propagate frame number */
if (status & CSI2_CTX_IRQ_FS) { if (status & CSI2_CTX_IRQ_FS) {
...@@ -745,15 +737,15 @@ void omap4iss_csi2_isr(struct iss_csi2_device *csi2) ...@@ -745,15 +737,15 @@ void omap4iss_csi2_isr(struct iss_csi2_device *csi2)
if (!csi2->available) if (!csi2->available)
return; return;
csi2_irqstatus = readl(csi2->regs1 + CSI2_IRQSTATUS); csi2_irqstatus = iss_reg_read(csi2->iss, csi2->regs1, CSI2_IRQSTATUS);
writel(csi2_irqstatus, csi2->regs1 + CSI2_IRQSTATUS); iss_reg_write(csi2->iss, csi2->regs1, CSI2_IRQSTATUS, csi2_irqstatus);
/* Failure Cases */ /* Failure Cases */
if (csi2_irqstatus & CSI2_IRQ_COMPLEXIO_ERR) { if (csi2_irqstatus & CSI2_IRQ_COMPLEXIO_ERR) {
cpxio1_irqstatus = readl(csi2->regs1 + cpxio1_irqstatus = iss_reg_read(csi2->iss, csi2->regs1,
CSI2_COMPLEXIO_IRQSTATUS); CSI2_COMPLEXIO_IRQSTATUS);
writel(cpxio1_irqstatus, iss_reg_write(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_IRQSTATUS,
csi2->regs1 + CSI2_COMPLEXIO_IRQSTATUS); cpxio1_irqstatus);
dev_dbg(iss->dev, "CSI2: ComplexIO Error IRQ %x\n", dev_dbg(iss->dev, "CSI2: ComplexIO Error IRQ %x\n",
cpxio1_irqstatus); cpxio1_irqstatus);
pipe->error = true; pipe->error = true;
...@@ -1319,7 +1311,7 @@ int omap4iss_csi2_init(struct iss_device *iss) ...@@ -1319,7 +1311,7 @@ int omap4iss_csi2_init(struct iss_device *iss)
csi2a->iss = iss; csi2a->iss = iss;
csi2a->available = 1; csi2a->available = 1;
csi2a->regs1 = iss->regs[OMAP4_ISS_MEM_CSI2_A_REGS1]; csi2a->regs1 = OMAP4_ISS_MEM_CSI2_A_REGS1;
csi2a->phy = &iss->csiphy1; csi2a->phy = &iss->csiphy1;
csi2a->state = ISS_PIPELINE_STREAM_STOPPED; csi2a->state = ISS_PIPELINE_STREAM_STOPPED;
init_waitqueue_head(&csi2a->wait); init_waitqueue_head(&csi2a->wait);
...@@ -1330,7 +1322,7 @@ int omap4iss_csi2_init(struct iss_device *iss) ...@@ -1330,7 +1322,7 @@ int omap4iss_csi2_init(struct iss_device *iss)
csi2b->iss = iss; csi2b->iss = iss;
csi2b->available = 1; csi2b->available = 1;
csi2b->regs1 = iss->regs[OMAP4_ISS_MEM_CSI2_B_REGS1]; csi2b->regs1 = OMAP4_ISS_MEM_CSI2_B_REGS1;
csi2b->phy = &iss->csiphy2; csi2b->phy = &iss->csiphy2;
csi2b->state = ISS_PIPELINE_STREAM_STOPPED; csi2b->state = ISS_PIPELINE_STREAM_STOPPED;
init_waitqueue_head(&csi2b->wait); init_waitqueue_head(&csi2b->wait);
......
drivers/staging/media/omap4iss/iss_csi2.h
View file @ 97059524
...@@ -128,9 +128,9 @@ struct iss_csi2_device { ...@@ -128,9 +128,9 @@ struct iss_csi2_device {
u8 available; /* Is the IP present on the silicon? */ u8 available; /* Is the IP present on the silicon? */
/* Pointer to register remaps into kernel space */ /* memory resources, as defined in enum iss_mem_resources */
void __iomem *regs1; unsigned int regs1;
void __iomem *regs2; unsigned int regs2;
u32 output; /* output to IPIPEIF, memory or both? */ u32 output; /* output to IPIPEIF, memory or both? */
bool dpcm_decompress; bool dpcm_decompress;
......
drivers/staging/media/omap4iss/iss_csiphy.c
View file @ 97059524
...@@ -31,7 +31,7 @@ static void csiphy_lanes_config(struct iss_csiphy *phy) ...@@ -31,7 +31,7 @@ static void csiphy_lanes_config(struct iss_csiphy *phy)
unsigned int i; unsigned int i;
u32 reg; u32 reg;
reg = readl(phy->cfg_regs + CSI2_COMPLEXIO_CFG); reg = iss_reg_read(phy->iss, phy->cfg_regs, CSI2_COMPLEXIO_CFG);
for (i = 0; i < phy->max_data_lanes; i++) { for (i = 0; i < phy->max_data_lanes; i++) {
reg &= ~(CSI2_COMPLEXIO_CFG_DATA_POL(i + 1) | reg &= ~(CSI2_COMPLEXIO_CFG_DATA_POL(i + 1) |
...@@ -47,7 +47,7 @@ static void csiphy_lanes_config(struct iss_csiphy *phy) ...@@ -47,7 +47,7 @@ static void csiphy_lanes_config(struct iss_csiphy *phy)
reg |= phy->lanes.clk.pol ? CSI2_COMPLEXIO_CFG_CLOCK_POL : 0; reg |= phy->lanes.clk.pol ? CSI2_COMPLEXIO_CFG_CLOCK_POL : 0;
reg |= phy->lanes.clk.pos << CSI2_COMPLEXIO_CFG_CLOCK_POSITION_SHIFT; reg |= phy->lanes.clk.pos << CSI2_COMPLEXIO_CFG_CLOCK_POSITION_SHIFT;
writel(reg, phy->cfg_regs + CSI2_COMPLEXIO_CFG); iss_reg_write(phy->iss, phy->cfg_regs, CSI2_COMPLEXIO_CFG, reg);
} }
/* /*
...@@ -61,16 +61,15 @@ static int csiphy_set_power(struct iss_csiphy *phy, u32 power) ...@@ -61,16 +61,15 @@ static int csiphy_set_power(struct iss_csiphy *phy, u32 power)
u32 reg; u32 reg;
u8 retry_count; u8 retry_count;
writel((readl(phy->cfg_regs + CSI2_COMPLEXIO_CFG) & iss_reg_update(phy->iss, phy->cfg_regs, CSI2_COMPLEXIO_CFG,
~CSI2_COMPLEXIO_CFG_PWD_CMD_MASK) | CSI2_COMPLEXIO_CFG_PWD_CMD_MASK,
power | CSI2_COMPLEXIO_CFG_PWR_AUTO, power | CSI2_COMPLEXIO_CFG_PWR_AUTO);
phy->cfg_regs + CSI2_COMPLEXIO_CFG);
retry_count = 0; retry_count = 0;
do { do {
udelay(1); udelay(1);
reg = readl(phy->cfg_regs + CSI2_COMPLEXIO_CFG) & reg = iss_reg_read(phy->iss, phy->cfg_regs, CSI2_COMPLEXIO_CFG)
CSI2_COMPLEXIO_CFG_PWD_STATUS_MASK; & CSI2_COMPLEXIO_CFG_PWD_STATUS_MASK;
if (reg != power >> 2) if (reg != power >> 2)
retry_count++; retry_count++;
...@@ -98,7 +97,7 @@ static void csiphy_dphy_config(struct iss_csiphy *phy) ...@@ -98,7 +97,7 @@ static void csiphy_dphy_config(struct iss_csiphy *phy)
reg = phy->dphy.ths_term << REGISTER0_THS_TERM_SHIFT; reg = phy->dphy.ths_term << REGISTER0_THS_TERM_SHIFT;
reg |= phy->dphy.ths_settle << REGISTER0_THS_SETTLE_SHIFT; reg |= phy->dphy.ths_settle << REGISTER0_THS_SETTLE_SHIFT;
writel(reg, phy->phy_regs + REGISTER0); iss_reg_write(phy->iss, phy->phy_regs, REGISTER0, reg);
/* Set up REGISTER1 */ /* Set up REGISTER1 */
reg = phy->dphy.tclk_term << REGISTER1_TCLK_TERM_SHIFT; reg = phy->dphy.tclk_term << REGISTER1_TCLK_TERM_SHIFT;
...@@ -106,7 +105,7 @@ static void csiphy_dphy_config(struct iss_csiphy *phy) ...@@ -106,7 +105,7 @@ static void csiphy_dphy_config(struct iss_csiphy *phy)
reg |= phy->dphy.tclk_settle << REGISTER1_TCLK_SETTLE_SHIFT; reg |= phy->dphy.tclk_settle << REGISTER1_TCLK_SETTLE_SHIFT;
reg |= 0xB8 << REGISTER1_DPHY_HS_SYNC_PATTERN_SHIFT; reg |= 0xB8 << REGISTER1_DPHY_HS_SYNC_PATTERN_SHIFT;
writel(reg, phy->phy_regs + REGISTER1); iss_reg_write(phy->iss, phy->phy_regs, REGISTER1, reg);
} }
/* /*
...@@ -264,16 +263,16 @@ int omap4iss_csiphy_init(struct iss_device *iss) ...@@ -264,16 +263,16 @@ int omap4iss_csiphy_init(struct iss_device *iss)
phy1->csi2 = &iss->csi2a; phy1->csi2 = &iss->csi2a;
phy1->max_data_lanes = ISS_CSIPHY1_NUM_DATA_LANES; phy1->max_data_lanes = ISS_CSIPHY1_NUM_DATA_LANES;
phy1->used_data_lanes = 0; phy1->used_data_lanes = 0;
phy1->cfg_regs = iss->regs[OMAP4_ISS_MEM_CSI2_A_REGS1]; phy1->cfg_regs = OMAP4_ISS_MEM_CSI2_A_REGS1;
phy1->phy_regs = iss->regs[OMAP4_ISS_MEM_CAMERARX_CORE1]; phy1->phy_regs = OMAP4_ISS_MEM_CAMERARX_CORE1;
mutex_init(&phy1->mutex); mutex_init(&phy1->mutex);
phy2->iss = iss; phy2->iss = iss;
phy2->csi2 = &iss->csi2b; phy2->csi2 = &iss->csi2b;
phy2->max_data_lanes = ISS_CSIPHY2_NUM_DATA_LANES; phy2->max_data_lanes = ISS_CSIPHY2_NUM_DATA_LANES;
phy2->used_data_lanes = 0; phy2->used_data_lanes = 0;
phy2->cfg_regs = iss->regs[OMAP4_ISS_MEM_CSI2_B_REGS1]; phy2->cfg_regs = OMAP4_ISS_MEM_CSI2_B_REGS1;
phy2->phy_regs = iss->regs[OMAP4_ISS_MEM_CAMERARX_CORE2]; phy2->phy_regs = OMAP4_ISS_MEM_CAMERARX_CORE2;
mutex_init(&phy2->mutex); mutex_init(&phy2->mutex);
return 0; return 0;
......
drivers/staging/media/omap4iss/iss_csiphy.h
View file @ 97059524
...@@ -32,9 +32,9 @@ struct iss_csiphy { ...@@ -32,9 +32,9 @@ struct iss_csiphy {
u8 phy_in_use; u8 phy_in_use;
struct iss_csi2_device *csi2; struct iss_csi2_device *csi2;
/* Pointer to register remaps into kernel space */ /* memory resources, as defined in enum iss_mem_resources */
void __iomem *cfg_regs; unsigned int cfg_regs;
void __iomem *phy_regs; unsigned int phy_regs;
u8 max_data_lanes; /* number of CSI2 Data Lanes supported */ u8 max_data_lanes; /* number of CSI2 Data Lanes supported */
u8 used_data_lanes; /* number of CSI2 Data Lanes used */ u8 used_data_lanes; /* number of CSI2 Data Lanes used */
......
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
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7