/* * Samsung S5P SoC series MIPI-CSI2 slave interface driver * * Copyright (c) 2010 Samsung Electronics Co., Ltd * Contact: Sylwester Nawrocki, * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include static int debug; module_param(debug, int, 0644); MODULE_PARM_DESC(debug, "Enable module debug trace. Set to 1 to enable."); #define MODULE_NAME "s5p-mipi-csis" /* Register map definition */ /* CSI global control. */ #define S5P_CSIS_CTRL 0x00 #define S5P_CSIS_CTRL_DPDN_DEFAULT (0 << 31) #define S5P_CSIS_CTRL_DPDN_SWAP (1 << 31) #define S5P_CSIS_CTRL_ALIGN_32BIT (1 << 20) #define S5P_CSIS_CTRL_UPDATE_SHADOW (1 << 16) #define S5P_CSIS_CTRL_WCLK_EXTCLK (1 << 8) #define S5P_CSIS_CTRL_RESET (1 << 4) #define S5P_CSIS_CTRL_ENABLE (1 << 0) /* D-PHY control. */ #define S5P_CSIS_DPHYCTRL 0x04 #define S5P_CSIS_DPHYCTRL_HSS_MASK (0x1F << 27) /* 4-lanes #define S5P_CSIS_DPHYCTRL_ENABLE (0x1F << 0) */ #define S5P_CSIS_DPHYCTRL_ENABLE (0x1F << 0) #define S5P_CSIS_CONFIG 0x08 #define S5P_CSIS_CFG_FMT_YCBCR422_8BIT (0x1E << 2) #define S5P_CSIS_CFG_FMT_RAW8 (0x2A << 2) #define S5P_CSIS_CFG_FMT_RAW10 (0x2B << 2) #define S5P_CSIS_CFG_FMT_RAW12 (0x2C << 2) /* User defined formats. x = 1...4. */ #define S5P_CSIS_CFG_FMT_USER(x) ((0x30 + x - 1) << 2) #define S5P_CSIS_CFG_FMT_MASK (0x3F << 2) #define S5P_CSIS_CFG_NR_LANE_MASK 3 /* Interrupt mask. */ #define S5P_CSIS_INTMSK 0x10 #define S5P_CSIS_INTMSK_EN_ALL 0xF000103F #define S5P_CSIS_INTSRC 0x14 /* Interrupt Source Register */ #define S5P_CSIS_INTSRC_EVEN_BEFORE (1 << 31) #define S5P_CSIS_INTSRC_EVEN_AFTER (1 << 30) #define S5P_CSIS_INTSRC_ODD_BEFORE (1 << 29) #define S5P_CSIS_INTSRC_ODD_AFTER (1 << 28) #define S5P_CSIS_INTSRC_ERR_SOT_HS (0xF << 12) #define S5P_CSIS_INTSRC_ERR_LOST_FS (1 << 5) #define S5P_CSIS_INTSRC_ERR_LOST_FE (1 << 4) #define S5P_CSIS_INTSRC_ERR_OVER (1 << 3) #define S5P_CSIS_INTSRC_ERR_ECC (1 << 2) #define S5P_CSIS_INTSRC_ERR_CRC (1 << 1) #define S5P_CSIS_INTSRC_ERR_ID (1 << 0) #define S5P_CSIS_INTSRC_ERR (S5P_CSIS_INTSRC_ERR_SOT_HS | \ S5P_CSIS_INTSRC_ERR_LOST_FS | \ S5P_CSIS_INTSRC_ERR_LOST_FE | \ S5P_CSIS_INTSRC_ERR_OVER | \ S5P_CSIS_INTSRC_ERR_ECC | \ S5P_CSIS_INTSRC_ERR_CRC | \ S5P_CSIS_INTSRC_ERR_ID) /* Pixel resolution. */ #define S5P_CSIS_RESOL 0x2C #define CSIS_MAX_PIX_WIDTH 0xFFFF #define CSIS_MAX_PIX_HEIGHT 0xFFFF enum { CSIS_CLK_BUS, CSIS_CLK_GATE, }; static char *csi_clock_name[] = { [CSIS_CLK_BUS] = "sclk_csis", [CSIS_CLK_GATE] = "csis", }; #define NUM_CSIS_CLOCKS ARRAY_SIZE(csi_clock_name) enum { CSIS_PWR_ST_POWERED, CSIS_PWR_ST_STREAMING, CSIS_PWR_ST_SUSPENDED, }; struct s5p_csis_state { struct mutex lock; struct v4l2_subdev sd; struct v4l2_mbus_framefmt fmt; struct platform_device *pdev; struct resource *regs_res; void __iomem *regs; int irq; struct clk *clock[NUM_CSIS_CLOCKS]; struct regulator *supply; unsigned long power; }; struct s5p_csis_color_format { enum v4l2_mbus_pixelcode code; u32 fmt_reg; u16 pix_hor_align; }; static s32 err_print_cnt; static const struct s5p_csis_color_format s5p_csis_formats[] = { { .code = V4L2_MBUS_FMT_YUYV8_2X8, .fmt_reg = S5P_CSIS_CFG_FMT_YCBCR422_8BIT, .pix_hor_align = 1, }, { .code = V4L2_MBUS_FMT_JPEG_1X8, .fmt_reg = S5P_CSIS_CFG_FMT_USER(1), .pix_hor_align = 1, }, { .code = V4L2_MBUS_FMT_SGRBG10_1X10, .fmt_reg = S5P_CSIS_CFG_FMT_RAW10, .pix_hor_align = 1, }, }; static struct s5p_csis_state *to_s5p_csis_state(struct v4l2_subdev *sdev) { return container_of(sdev, struct s5p_csis_state, sd); } static void s5p_csis_enable_interrupts(struct s5p_csis_state *state, int on) { u32 cfg = readl(state->regs + S5P_CSIS_CTRL); if (on) cfg |= S5P_CSIS_INTMSK_EN_ALL; else cfg &= ~S5P_CSIS_INTMSK_EN_ALL; writel(cfg, state->regs + S5P_CSIS_INTMSK); } static void s5p_csis_reset(struct s5p_csis_state *state) { u32 cfg = readl(state->regs + S5P_CSIS_CTRL); writel(cfg | S5P_CSIS_CTRL_RESET, state->regs + S5P_CSIS_CTRL); udelay(10); } static void s5p_csis_system_enable(struct s5p_csis_state *state, int on) { u32 cfg; cfg = readl(state->regs + S5P_CSIS_CTRL); if (on) cfg |= S5P_CSIS_CTRL_ENABLE; else cfg &= ~S5P_CSIS_CTRL_ENABLE; writel(cfg, state->regs + S5P_CSIS_CTRL); cfg = readl(state->regs + S5P_CSIS_DPHYCTRL); if (on) cfg |= S5P_CSIS_DPHYCTRL_ENABLE; else cfg &= ~S5P_CSIS_DPHYCTRL_ENABLE; writel(cfg, state->regs + S5P_CSIS_DPHYCTRL); s5p_csis_enable_interrupts(state, on); } static int s5p_csis_set_format(struct s5p_csis_state *state) { u32 cfg; int i = ARRAY_SIZE(s5p_csis_formats); v4l2_dbg(1, debug, &state->sd, "fmt: %d, %d x %d\n", state->fmt.code, state->fmt.width, state->fmt.height); /* Color format */ cfg = readl(state->regs + S5P_CSIS_CONFIG); cfg &= ~S5P_CSIS_CFG_FMT_MASK; while (i--) if (state->fmt.code == s5p_csis_formats[i].code) break; if (i >= ARRAY_SIZE(s5p_csis_formats)) return -EINVAL; writel(cfg | s5p_csis_formats[i].fmt_reg, state->regs + S5P_CSIS_CONFIG); /* Pixel resolution */ cfg = (state->fmt.width << 16) | state->fmt.height; writel(cfg, state->regs + S5P_CSIS_RESOL); return 0; } static void s5p_csis_set_hsync_settle(struct s5p_csis_state *state, int settle) { u32 cfg = readl(state->regs + S5P_CSIS_DPHYCTRL); cfg &= ~S5P_CSIS_DPHYCTRL_HSS_MASK; cfg |= (settle << 27); writel(cfg, state->regs + S5P_CSIS_DPHYCTRL); } static void s5p_csis_set_params(struct s5p_csis_state *state) { struct s5p_platform_mipi_csis *pdata = state->pdev->dev.platform_data; u32 cfg, tmp; /* Number of MIPI lanes used */ cfg = readl(state->regs + S5P_CSIS_CONFIG); cfg &= ~S5P_CSIS_CFG_NR_LANE_MASK; tmp = (pdata->lanes - 1) & 0x3; writel(cfg | tmp, state->regs + S5P_CSIS_CONFIG); s5p_csis_set_format(state); s5p_csis_set_hsync_settle(state, pdata->hs_settle); /* CSI bus data alignment. */ cfg = readl(state->regs + S5P_CSIS_CTRL); if (pdata->alignment == 32) cfg |= S5P_CSIS_CTRL_ALIGN_32BIT; else /* 24-bits */ cfg &= ~S5P_CSIS_CTRL_ALIGN_32BIT; /* Not using external clock. */ cfg |= S5P_CSIS_CTRL_WCLK_EXTCLK; writel(cfg, state->regs + S5P_CSIS_CTRL); /* Update the shadow register. */ cfg = readl(state->regs + S5P_CSIS_CTRL); writel(cfg | S5P_CSIS_CTRL_UPDATE_SHADOW, state->regs + S5P_CSIS_CTRL); } static void s5p_csis_clk_enable(struct s5p_csis_state *state, bool on) { int i; for (i = 0; i < NUM_CSIS_CLOCKS; i++) { if (!state->clock[i]) continue; if (on) clk_enable(state->clock[i]); else clk_disable(state->clock[i]); } v4l2_dbg(1, debug, &state->sd, "%s: clocks %sabled\n", __func__, on ? "en" : "dis"); } static void s5p_csis_clk_put(struct s5p_csis_state *state) { int i = NUM_CSIS_CLOCKS; while (--i >= 0) { if (!state->clock[i]) continue; clk_put(state->clock[i]); } } static int s5p_csis_clk_get(struct s5p_csis_state *state) { struct device *dev = &state->pdev->dev; int i; for (i = 0; i < NUM_CSIS_CLOCKS; i++) { state->clock[i] = clk_get(dev, csi_clock_name[i]); if (IS_ERR(state->clock[i])) { dev_err(dev, "failed to get clock: %s\n", csi_clock_name[i]); return -ENXIO; } } return 0; } static int mipi_csis_power(struct v4l2_subdev *sd, int on) { struct s5p_csis_state *state = to_s5p_csis_state(sd); struct s5p_platform_mipi_csis *pdata = state->pdev->dev.platform_data; int ret; if (on) { ret = regulator_enable(state->supply); if (!ret && pdata->phy_enable) ret = pdata->phy_enable(state->pdev, true); if (!ret) set_bit(CSIS_PWR_ST_POWERED, &state->power); } else { if (pdata->phy_enable) { ret = pdata->phy_enable(state->pdev, false); if (ret) return ret; } ret = regulator_disable(state->supply); if (!ret) clear_bit(CSIS_PWR_ST_POWERED, &state->power); } if (!ret) v4l2_dbg(1, debug, sd, "%s: regulator is %s\n", __func__, on ? "on" : "off"); return ret; } static int s5p_csis_s_power(struct v4l2_subdev *sd, int on) { struct s5p_csis_state *state = to_s5p_csis_state(sd); struct device *dev = &state->pdev->dev; int ret = 0; v4l2_dbg(1, debug, sd, "%s: on: %d, state: 0x%lx\n", __func__, on, state->power); if (on) { set_bit(CSIS_PWR_ST_POWERED, &state->power); ret = pm_runtime_get_sync(dev); } else ret = pm_runtime_put_sync(dev); if ((!ret && !on) || (ret && on)) clear_bit(CSIS_PWR_ST_POWERED, &state->power); return ret; } static inline struct s5p_csis_color_format const *find_csis_format( struct v4l2_mbus_framefmt *mf) { int i = ARRAY_SIZE(s5p_csis_formats); while (i--) if (mf->code == s5p_csis_formats[i].code) break; if (i < 0) return NULL; return &s5p_csis_formats[i]; } static int s5p_csis_try_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *mf) { struct s5p_csis_color_format const *csis_fmt; if (!sd || !mf) return -EINVAL; csis_fmt = find_csis_format(mf); if (csis_fmt == NULL) csis_fmt = &s5p_csis_formats[0]; mf->code = csis_fmt->code; /* Adjust pixel size if required so it fits in the supported range and meets the aligment requirements. */ v4l_bound_align_image(&mf->width, 1, CSIS_MAX_PIX_WIDTH, csis_fmt->pix_hor_align, &mf->height, 1, CSIS_MAX_PIX_HEIGHT, 1, 0); return 0; } static int s5p_csis_s_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *mf) { struct s5p_csis_state *state = to_s5p_csis_state(sd); struct s5p_csis_color_format const *csis_fmt = find_csis_format(mf); v4l2_dbg(1, debug, sd, "%s: w: %d, h: %d\n", __func__, mf->width, mf->height); if (csis_fmt == NULL || mf->width > CSIS_MAX_PIX_WIDTH || mf->height > CSIS_MAX_PIX_WIDTH || mf->width & (u32)(csis_fmt->pix_hor_align - 1)) return -EINVAL; printk(KERN_DEBUG "%s: w: %d, h: %d\n", __func__, mf->width, mf->height); state->fmt = *mf; return 0; } static int s5p_csis_g_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *mf) { struct s5p_csis_state *state = to_s5p_csis_state(sd); *mf = state->fmt; return 0; } static void s5p_csis_start_stream(struct s5p_csis_state *state) { s5p_csis_reset(state); s5p_csis_set_params(state); s5p_csis_system_enable(state, true); } static void s5p_csis_stop_stream(struct s5p_csis_state *state) { s5p_csis_enable_interrupts(state, false); s5p_csis_system_enable(state, false); } static int s5p_csis_s_stream(struct v4l2_subdev *sd, int enable) { struct s5p_csis_state *state = to_s5p_csis_state(sd); v4l2_dbg(1, debug, sd, "%s: %d, state: 0x%lx\n", __func__, enable, state->power); if (test_bit(CSIS_PWR_ST_SUSPENDED, &state->power)) return -EBUSY; mutex_lock(&state->lock); if (enable) { s5p_csis_start_stream(state); set_bit(CSIS_PWR_ST_STREAMING, &state->power); } else { s5p_csis_stop_stream(state); clear_bit(CSIS_PWR_ST_STREAMING, &state->power); } mutex_unlock(&state->lock); return 0; } static struct v4l2_subdev_core_ops s5p_csis_core_ops = { .s_power = s5p_csis_s_power, }; static struct v4l2_subdev_video_ops s5p_csis_video_ops = { .try_mbus_fmt = s5p_csis_try_fmt, .g_mbus_fmt = s5p_csis_g_fmt, .s_mbus_fmt = s5p_csis_s_fmt, .s_stream = s5p_csis_s_stream, }; static struct v4l2_subdev_ops s5p_csis_subdev_ops = { .core = &s5p_csis_core_ops, .video = &s5p_csis_video_ops, }; static irqreturn_t s5p_csis_isr(int irq, void *dev_id) { struct s5p_csis_state *state = dev_id; u32 cfg; /* Just clear the interrupt pending bits. */ cfg = readl(state->regs + S5P_CSIS_INTSRC); writel(cfg, state->regs + S5P_CSIS_INTSRC); if (unlikely(cfg & S5P_CSIS_INTSRC_ERR)) { if (err_print_cnt < 30) { printk(KERN_ERR "csis error interrupt[%d]: %#x\n", err_print_cnt, cfg); err_print_cnt++; } } return IRQ_HANDLED; } static int s5p_csis_probe(struct platform_device *pdev) { struct s5p_platform_mipi_csis *pdata; struct resource *mem_res; struct resource *regs_res; struct s5p_csis_state *state; int ret = -ENODEV; state = kzalloc(sizeof(*state), GFP_KERNEL); if (!state) return -ENOMEM; mutex_init(&state->lock); state->pdev = pdev; pdata = pdev->dev.platform_data; if (!pdata) { dev_err(&pdev->dev, "Platform data not set\n"); goto p_err1; } mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!mem_res) { dev_err(&pdev->dev, "Failed to get io memory region\n"); goto p_err1; } regs_res = request_mem_region(mem_res->start, resource_size(mem_res), pdev->name); if (!regs_res) { dev_err(&pdev->dev, "Failed to request io memory region\n"); goto p_err1; } state->regs_res = regs_res; state->regs = ioremap(mem_res->start, resource_size(mem_res)); if (!state->regs) { dev_err(&pdev->dev, "Failed to remap io region\n"); goto p_err2; } if (s5p_csis_clk_get(state)) goto p_err3; if (pdata->clk_rate) { struct clk *srclk; if (soc_is_exynos4212() || soc_is_exynos4412()) srclk = clk_get(&state->pdev->dev, "mout_mpll_user"); else srclk = clk_get(&state->pdev->dev, "mout_mpll"); if (IS_ERR_OR_NULL(srclk)) { dev_err(&state->pdev->dev, "failed to get mipi-csis source clock\n"); return -ENXIO; } clk_set_parent(state->clock[CSIS_CLK_BUS], srclk); clk_put(srclk); clk_set_rate(state->clock[CSIS_CLK_BUS], pdata->clk_rate); } if (pdata->phy_enable) pdata->phy_enable(state->pdev, false); state->irq = platform_get_irq(pdev, 0); if (state->irq < 0) { dev_err(&pdev->dev, "failed to get irq\n"); goto p_err4; } ret = request_irq(state->irq, s5p_csis_isr, 0, dev_name(&pdev->dev), state); if (ret) { dev_err(&pdev->dev, "request_irq failed\n"); goto p_err4; } state->supply = regulator_get(&pdev->dev, "mipi_csi"); if (IS_ERR(state->supply)) { state->supply = NULL; goto p_err5; } v4l2_subdev_init(&state->sd, &s5p_csis_subdev_ops); state->sd.owner = THIS_MODULE; strcpy(state->sd.name, MODULE_NAME); /* This allows to retrieve the platform device id by the host driver */ v4l2_set_subdevdata(&state->sd, pdev); /* .. and a pointer to the subdev. */ platform_set_drvdata(pdev, &state->sd); pm_runtime_enable(&pdev->dev); v4l2_info(&state->sd, "mipi-csis%d probed\n", pdev->id); return 0; p_err5: free_irq(state->irq, state); p_err4: s5p_csis_clk_put(state); p_err3: iounmap(state->regs); p_err2: release_mem_region(regs_res->start, resource_size(regs_res)); p_err1: kfree(state); return ret; } static int s5p_csis_remove(struct platform_device *pdev) { struct v4l2_subdev *sd = platform_get_drvdata(pdev); struct s5p_csis_state *state = to_s5p_csis_state(sd); struct resource *res = state->regs_res; s5p_csis_s_power(&state->sd, 0); pm_runtime_disable(&pdev->dev); s5p_csis_clk_put(state); free_irq(state->irq, state); iounmap(state->regs); release_mem_region(res->start, resource_size(res)); kfree(state); return 0; } static int s5p_csis_suspend(struct device *dev) { struct platform_device *pdev = to_platform_device(dev); struct v4l2_subdev *sd = platform_get_drvdata(pdev); struct s5p_csis_state *state = to_s5p_csis_state(sd); mutex_lock(&state->lock); v4l2_dbg(1, debug, sd, "%s: state: 0x%lx\n", __func__, state->power); if (test_bit(CSIS_PWR_ST_POWERED, &state->power)) { s5p_csis_stop_stream(state); mipi_csis_power(sd, 0); s5p_csis_clk_enable(to_s5p_csis_state(sd), false); } set_bit(CSIS_PWR_ST_SUSPENDED, &state->power); mutex_unlock(&state->lock); return 0; } static int s5p_csis_resume(struct device *dev) { struct platform_device *pdev = to_platform_device(dev); struct v4l2_subdev *sd = platform_get_drvdata(pdev); struct s5p_csis_state *state = to_s5p_csis_state(sd); mutex_lock(&state->lock); v4l2_dbg(1, debug, sd, "%s: state: 0x%lx\n", __func__, state->power); if (test_bit(CSIS_PWR_ST_POWERED, &state->power)) { mipi_csis_power(sd, 1); s5p_csis_clk_enable(to_s5p_csis_state(sd), true); } if (test_bit(CSIS_PWR_ST_STREAMING, &state->power)) s5p_csis_start_stream(state); clear_bit(CSIS_PWR_ST_SUSPENDED, &state->power); mutex_unlock(&state->lock); return 0; } static const struct dev_pm_ops s5p_csis_pm_ops = { .runtime_suspend = s5p_csis_suspend, .runtime_resume = s5p_csis_resume, .suspend = s5p_csis_suspend, .resume = s5p_csis_resume, }; static struct platform_driver s5p_csis_driver = { .probe = s5p_csis_probe, .remove = s5p_csis_remove, .driver = { .name = MODULE_NAME, .owner = THIS_MODULE, .pm = &s5p_csis_pm_ops, }, }; static int __init s5p_csis_init(void) { return platform_driver_probe(&s5p_csis_driver, s5p_csis_probe); } static void __exit s5p_csis_exit(void) { platform_driver_unregister(&s5p_csis_driver); } module_init(s5p_csis_init); module_exit(s5p_csis_exit); MODULE_AUTHOR("Sylwester Nawrocki, "); MODULE_DESCRIPTION("S5P MIPI-CSI2 slave interface driver"); MODULE_LICENSE("GPL");