static void get_disp_ipu(cam_data *cam) { if (cam->output > 2) disp_ipu = ipu_get_soc(1); /* using DISP4 */ else disp_ipu = ipu_get_soc(0); }
static int _ipu_pixel_clk_div_set_rate(struct clk_hw *hw, unsigned long rate, unsigned long parent_clk_rate) { struct clk_di_div *di_div = to_clk_di_div(hw); struct ipu_soc *ipu = ipu_get_soc(di_div->ipu_id); u64 div, parent_rate; u64 remainder; parent_rate = (unsigned long long)parent_clk_rate * 16; div = parent_rate; div = do_udiv64(div, rate, &remainder); /* Round the divider value */ if (remainder > (rate/2)) div++; /* Round up divider if it gets us closer to desired pix clk */ if ((div & 0xC) == 0xC) { div += 0x10; div &= ~0xF; } if (div > 0x1000) pr_err("Overflow, di:%d, DI_BS_CLKGEN0 div:0x%x\n", di_div->di_id, (u32)div); _ipu_get(ipu); ipu_di_write(ipu, di_div->di_id, (u32)div, DI_BS_CLKGEN0); /* Setup pixel clock timing */ /* FIXME: needs to be more flexible */ /* Down time is half of period */ ipu_di_write(ipu, di_div->di_id, ((u32)div / 16) << 16, DI_BS_CLKGEN1); _ipu_put(ipu); return 0; }
static void _ipu_pixel_clk_disable(struct clk_hw *hw) { struct clk_di_gate *gate = to_clk_di_gate(hw); struct ipu_soc *ipu = ipu_get_soc(gate->ipu_id); u32 disp_gen; disp_gen = ipu_cm_read(ipu, IPU_DISP_GEN); disp_gen &= gate->di_id ? ~DI1_COUNTER_RELEASE : ~DI0_COUNTER_RELEASE; ipu_cm_write(ipu, disp_gen, IPU_DISP_GEN); }
static int _ipu_pixel_clk_enable(struct clk_hw *hw) { struct clk_di_gate *gate = to_clk_di_gate(hw); struct ipu_soc *ipu = ipu_get_soc(gate->ipu_id); u32 disp_gen; disp_gen = ipu_cm_read(ipu, IPU_DISP_GEN); disp_gen |= gate->di_id ? DI1_COUNTER_RELEASE : DI0_COUNTER_RELEASE; ipu_cm_write(ipu, disp_gen, IPU_DISP_GEN); return 0; }
static int _ipu_pixel_clk_set_parent(struct clk_hw *hw, u8 index) { struct clk_di_mux *mux = to_clk_di_mux(hw); struct ipu_soc *ipu = ipu_get_soc(mux->ipu_id); u32 di_gen; di_gen = ipu_di_read(ipu, mux->di_id, DI_GENERAL); if (index == 0) /* ipu1_clk or ipu2_clk internal clk */ di_gen &= ~DI_GEN_DI_CLK_EXT; else di_gen |= DI_GEN_DI_CLK_EXT; ipu_di_write(ipu, mux->di_id, di_gen, DI_GENERAL); mux->index = index; pr_debug("ipu_pixel_clk: di_clk_ext:0x%x, di_gen reg:0x%x.\n", !(di_gen & DI_GEN_DI_CLK_EXT), di_gen); return 0; }
static unsigned long _ipu_pixel_clk_div_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) { struct clk_di_div *di_div = to_clk_di_div(hw); struct ipu_soc *ipu = ipu_get_soc(di_div->ipu_id); u32 div; u64 final_rate = (unsigned long long)parent_rate * 16; _ipu_get(ipu); div = ipu_di_read(ipu, di_div->di_id, DI_BS_CLKGEN0); _ipu_put(ipu); pr_debug("ipu_di%d read BS_CLKGEN0 div:%d, final_rate:%lld, prate:%ld\n", di_div->di_id, div, final_rate, parent_rate); if (div == 0) return 0; final_rate = udiv64(final_rate, div); return (unsigned long)final_rate; }
/*! * PrpENC enable channel setup function * * @param cam struct cam_data * mxc capture instance * * @return status */ static int prp_enc_setup(cam_data *cam) { ipu_channel_params_t enc; int err = 0; dma_addr_t dummy = cam->dummy_frame.buffer.m.offset; #ifdef CONFIG_MXC_MIPI_CSI2 void *mipi_csi2_info; int ipu_id; int csi_id; #endif CAMERA_TRACE("In prp_enc_setup\n"); if (!cam) { printk(KERN_ERR "cam private is NULL\n"); return -ENXIO; } memset(&enc, 0, sizeof(ipu_channel_params_t)); ipu_csi_get_window_size(cam->ipu, &enc.csi_prp_enc_mem.in_width, &enc.csi_prp_enc_mem.in_height, cam->csi); enc.csi_prp_enc_mem.in_pixel_fmt = IPU_PIX_FMT_UYVY; enc.csi_prp_enc_mem.out_width = cam->v2f.fmt.pix.width; enc.csi_prp_enc_mem.out_height = cam->v2f.fmt.pix.height; enc.csi_prp_enc_mem.csi = cam->csi; if (cam->rotation >= IPU_ROTATE_90_RIGHT) { enc.csi_prp_enc_mem.out_width = cam->v2f.fmt.pix.height; enc.csi_prp_enc_mem.out_height = cam->v2f.fmt.pix.width; } if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_YUV420) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_YUV420P; pr_info("YUV420\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_YVU420) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_YVU420P; pr_info("YVU420\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_YUV422P) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_YUV422P; pr_info("YUV422P\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_YUYV) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_YUYV; pr_info("YUYV\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_UYVY) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_UYVY; pr_info("UYVY\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_NV12) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_NV12; pr_info("NV12\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_BGR24) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_BGR24; pr_info("BGR24\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_RGB24) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_RGB24; pr_info("RGB24\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_RGB565) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_RGB565; pr_info("RGB565\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_BGR32) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_BGR32; pr_info("BGR32\n"); } else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_RGB32) { enc.csi_prp_enc_mem.out_pixel_fmt = IPU_PIX_FMT_RGB32; pr_info("RGB32\n"); } else { printk(KERN_ERR "format not supported\n"); return -EINVAL; } #ifdef CONFIG_MXC_MIPI_CSI2 mipi_csi2_info = mipi_csi2_get_info(); if (mipi_csi2_info) { if (mipi_csi2_get_status(mipi_csi2_info)) { ipu_id = mipi_csi2_get_bind_ipu(mipi_csi2_info); csi_id = mipi_csi2_get_bind_csi(mipi_csi2_info); if (cam->ipu == ipu_get_soc(ipu_id) && cam->csi == csi_id) { enc.csi_prp_enc_mem.mipi_en = true; enc.csi_prp_enc_mem.mipi_vc = mipi_csi2_get_virtual_channel(mipi_csi2_info); enc.csi_prp_enc_mem.mipi_id = mipi_csi2_get_datatype(mipi_csi2_info); mipi_csi2_pixelclk_enable(mipi_csi2_info); } else { enc.csi_prp_enc_mem.mipi_en = false; enc.csi_prp_enc_mem.mipi_vc = 0; enc.csi_prp_enc_mem.mipi_id = 0; } } else { enc.csi_prp_enc_mem.mipi_en = false; enc.csi_prp_enc_mem.mipi_vc = 0; enc.csi_prp_enc_mem.mipi_id = 0; } } #endif err = ipu_init_channel(cam->ipu, CSI_PRP_ENC_MEM, &enc); if (err != 0) { printk(KERN_ERR "ipu_init_channel %d\n", err); return err; } grotation = cam->rotation; if (cam->rotation >= IPU_ROTATE_90_RIGHT) { if (cam->rot_enc_bufs_vaddr[0]) { dma_free_coherent(0, cam->rot_enc_buf_size[0], cam->rot_enc_bufs_vaddr[0], cam->rot_enc_bufs[0]); } if (cam->rot_enc_bufs_vaddr[1]) { dma_free_coherent(0, cam->rot_enc_buf_size[1], cam->rot_enc_bufs_vaddr[1], cam->rot_enc_bufs[1]); } cam->rot_enc_buf_size[0] = PAGE_ALIGN(cam->v2f.fmt.pix.sizeimage); cam->rot_enc_bufs_vaddr[0] = (void *)dma_alloc_coherent(0, cam->rot_enc_buf_size[0], &cam->rot_enc_bufs[0], GFP_DMA | GFP_KERNEL); if (!cam->rot_enc_bufs_vaddr[0]) { printk(KERN_ERR "alloc enc_bufs0\n"); return -ENOMEM; } cam->rot_enc_buf_size[1] = PAGE_ALIGN(cam->v2f.fmt.pix.sizeimage); cam->rot_enc_bufs_vaddr[1] = (void *)dma_alloc_coherent(0, cam->rot_enc_buf_size[1], &cam->rot_enc_bufs[1], GFP_DMA | GFP_KERNEL); if (!cam->rot_enc_bufs_vaddr[1]) { dma_free_coherent(0, cam->rot_enc_buf_size[0], cam->rot_enc_bufs_vaddr[0], cam->rot_enc_bufs[0]); cam->rot_enc_bufs_vaddr[0] = NULL; cam->rot_enc_bufs[0] = 0; printk(KERN_ERR "alloc enc_bufs1\n"); return -ENOMEM; } err = ipu_init_channel_buffer(cam->ipu, CSI_PRP_ENC_MEM, IPU_OUTPUT_BUFFER, enc.csi_prp_enc_mem.out_pixel_fmt, enc.csi_prp_enc_mem.out_width, enc.csi_prp_enc_mem.out_height, enc.csi_prp_enc_mem.out_width, IPU_ROTATE_NONE, cam->rot_enc_bufs[0], cam->rot_enc_bufs[1], 0, 0, 0); if (err != 0) { printk(KERN_ERR "CSI_PRP_ENC_MEM err\n"); return err; } err = ipu_init_channel(cam->ipu, MEM_ROT_ENC_MEM, NULL); if (err != 0) { printk(KERN_ERR "MEM_ROT_ENC_MEM channel err\n"); return err; } err = ipu_init_channel_buffer(cam->ipu, MEM_ROT_ENC_MEM, IPU_INPUT_BUFFER, enc.csi_prp_enc_mem.out_pixel_fmt, enc.csi_prp_enc_mem.out_width, enc.csi_prp_enc_mem.out_height, enc.csi_prp_enc_mem.out_width, cam->rotation, cam->rot_enc_bufs[0], cam->rot_enc_bufs[1], 0, 0, 0); if (err != 0) { printk(KERN_ERR "MEM_ROT_ENC_MEM input buffer\n"); return err; } err = ipu_init_channel_buffer(cam->ipu, MEM_ROT_ENC_MEM, IPU_OUTPUT_BUFFER, enc.csi_prp_enc_mem.out_pixel_fmt, enc.csi_prp_enc_mem.out_height, enc.csi_prp_enc_mem.out_width, cam->v2f.fmt.pix.bytesperline / bytes_per_pixel(enc.csi_prp_enc_mem. out_pixel_fmt), IPU_ROTATE_NONE, dummy, dummy, 0, cam->offset.u_offset, cam->offset.v_offset); if (err != 0) { printk(KERN_ERR "MEM_ROT_ENC_MEM output buffer\n"); return err; } err = ipu_link_channels(cam->ipu, CSI_PRP_ENC_MEM, MEM_ROT_ENC_MEM); if (err < 0) { printk(KERN_ERR "link CSI_PRP_ENC_MEM-MEM_ROT_ENC_MEM\n"); return err; } err = ipu_enable_channel(cam->ipu, CSI_PRP_ENC_MEM); if (err < 0) { printk(KERN_ERR "ipu_enable_channel CSI_PRP_ENC_MEM\n"); return err; } err = ipu_enable_channel(cam->ipu, MEM_ROT_ENC_MEM); if (err < 0) { printk(KERN_ERR "ipu_enable_channel MEM_ROT_ENC_MEM\n"); return err; } ipu_select_buffer(cam->ipu, CSI_PRP_ENC_MEM, IPU_OUTPUT_BUFFER, 0); ipu_select_buffer(cam->ipu, CSI_PRP_ENC_MEM, IPU_OUTPUT_BUFFER, 1); } else { err = ipu_init_channel_buffer(cam->ipu, CSI_PRP_ENC_MEM, IPU_OUTPUT_BUFFER, enc.csi_prp_enc_mem.out_pixel_fmt, enc.csi_prp_enc_mem.out_width, enc.csi_prp_enc_mem.out_height, cam->v2f.fmt.pix.bytesperline / bytes_per_pixel(enc.csi_prp_enc_mem. out_pixel_fmt), cam->rotation, dummy, dummy, 0, cam->offset.u_offset, cam->offset.v_offset); if (err != 0) { printk(KERN_ERR "CSI_PRP_ENC_MEM output buffer\n"); return err; } err = ipu_enable_channel(cam->ipu, CSI_PRP_ENC_MEM); if (err < 0) { printk(KERN_ERR "ipu_enable_channel CSI_PRP_ENC_MEM\n"); return err; } } return err; }
/*! * CSI ENC enable channel setup function * * @param cam struct cam_data * mxc capture instance * * @return status */ static int csi_enc_setup(cam_data *cam) { ipu_channel_params_t params; u32 pixel_fmt; int err = 0, sensor_protocol = 0; dma_addr_t dummy = cam->dummy_frame.buffer.m.offset; #ifdef CONFIG_MXC_MIPI_CSI2 void *mipi_csi2_info; int ipu_id; int csi_id; #endif CAMERA_TRACE("In csi_enc_setup\n"); if (!cam) { printk(KERN_ERR "cam private is NULL\n"); return -ENXIO; } memset(¶ms, 0, sizeof(ipu_channel_params_t)); params.csi_mem.csi = cam->csi; sensor_protocol = ipu_csi_get_sensor_protocol(cam->ipu, cam->csi); switch (sensor_protocol) { case IPU_CSI_CLK_MODE_GATED_CLK: case IPU_CSI_CLK_MODE_NONGATED_CLK: case IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE: case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_DDR: case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_SDR: params.csi_mem.interlaced = false; break; case IPU_CSI_CLK_MODE_CCIR656_INTERLACED: case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_DDR: case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_SDR: params.csi_mem.interlaced = true; break; default: printk(KERN_ERR "sensor protocol unsupported\n"); return -EINVAL; } if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_YUV420) pixel_fmt = IPU_PIX_FMT_YUV420P; else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_YUV422P) pixel_fmt = IPU_PIX_FMT_YUV422P; else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_UYVY) pixel_fmt = IPU_PIX_FMT_UYVY; else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_YUYV) pixel_fmt = IPU_PIX_FMT_YUYV; else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_NV12) pixel_fmt = IPU_PIX_FMT_NV12; else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_BGR24) pixel_fmt = IPU_PIX_FMT_BGR24; else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_RGB24) pixel_fmt = IPU_PIX_FMT_RGB24; else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_RGB565) pixel_fmt = IPU_PIX_FMT_RGB565; else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_BGR32) pixel_fmt = IPU_PIX_FMT_BGR32; else if (cam->v2f.fmt.pix.pixelformat == V4L2_PIX_FMT_RGB32) pixel_fmt = IPU_PIX_FMT_RGB32; else { printk(KERN_ERR "format not supported\n"); return -EINVAL; } ipu_csi_enable_mclk_if(cam->ipu, CSI_MCLK_ENC, cam->csi, true, true); #ifdef CONFIG_MXC_MIPI_CSI2 mipi_csi2_info = mipi_csi2_get_info(); ipu_id = mipi_csi2_get_bind_ipu(mipi_csi2_info); csi_id = mipi_csi2_get_bind_csi(mipi_csi2_info); if (cam->ipu == ipu_get_soc(ipu_id) && cam->csi == csi_id) { params.csi_mem.mipi_en = true; params.csi_mem.mipi_vc = mipi_csi2_get_virtual_channel(mipi_csi2_info); params.csi_mem.mipi_id = mipi_csi2_get_datatype(mipi_csi2_info); mipi_csi2_pixelclk_enable(mipi_csi2_info); } #endif err = ipu_init_channel(cam->ipu, CSI_MEM, ¶ms); if (err != 0) { printk(KERN_ERR "ipu_init_channel %d\n", err); return err; } err = ipu_init_channel_buffer(cam->ipu, CSI_MEM, IPU_OUTPUT_BUFFER, pixel_fmt, cam->v2f.fmt.pix.width, cam->v2f.fmt.pix.height, cam->v2f.fmt.pix.width, IPU_ROTATE_NONE, dummy, dummy, 0, cam->offset.u_offset, cam->offset.v_offset); if (err != 0) { printk(KERN_ERR "CSI_MEM output buffer\n"); return err; } err = ipu_enable_channel(cam->ipu, CSI_MEM); if (err < 0) { printk(KERN_ERR "ipu_enable_channel CSI_MEM\n"); return err; } return err; }
static int csi_enc_setup(cam_data *cam) { ipu_channel_params_t params; int err = 0, sensor_protocol = 0; #ifdef CONFIG_MXC_MIPI_CSI2 void *mipi_csi2_info; int ipu_id; int csi_id; #endif CAMERA_TRACE("In csi_enc_setup\n"); if (!cam) { printk(KERN_ERR "cam private is NULL\n"); return -ENXIO; } memset(¶ms, 0, sizeof(ipu_channel_params_t)); params.csi_mem.csi = cam->csi; sensor_protocol = ipu_csi_get_sensor_protocol(cam->ipu, cam->csi); switch (sensor_protocol) { case IPU_CSI_CLK_MODE_GATED_CLK: case IPU_CSI_CLK_MODE_NONGATED_CLK: case IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE: case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_DDR: case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_SDR: params.csi_mem.interlaced = false; break; case IPU_CSI_CLK_MODE_CCIR656_INTERLACED: case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_DDR: case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_SDR: params.csi_mem.interlaced = true; break; default: printk(KERN_ERR "sensor protocol unsupported\n"); return -EINVAL; } #ifdef CONFIG_MXC_MIPI_CSI2 mipi_csi2_info = mipi_csi2_get_info(); if (mipi_csi2_info) { if (mipi_csi2_get_status(mipi_csi2_info)) { ipu_id = mipi_csi2_get_bind_ipu(mipi_csi2_info); csi_id = mipi_csi2_get_bind_csi(mipi_csi2_info); if (cam->ipu == ipu_get_soc(ipu_id) && cam->csi == csi_id) { params.csi_mem.mipi_en = true; params.csi_mem.mipi_vc = mipi_csi2_get_virtual_channel(mipi_csi2_info); params.csi_mem.mipi_id = mipi_csi2_get_datatype(mipi_csi2_info); mipi_csi2_pixelclk_enable(mipi_csi2_info); } else { params.csi_mem.mipi_en = false; params.csi_mem.mipi_vc = 0; params.csi_mem.mipi_id = 0; } } else { params.csi_mem.mipi_en = false; params.csi_mem.mipi_vc = 0; params.csi_mem.mipi_id = 0; } } #endif if (cam->vf_bufs_vaddr[0]) { dma_free_coherent(0, cam->vf_bufs_size[0], cam->vf_bufs_vaddr[0], (dma_addr_t) cam->vf_bufs[0]); } if (cam->vf_bufs_vaddr[1]) { dma_free_coherent(0, cam->vf_bufs_size[1], cam->vf_bufs_vaddr[1], (dma_addr_t) cam->vf_bufs[1]); } csi_mem_bufsize = cam->crop_current.width * cam->crop_current.height * 3/2; cam->vf_bufs_size[0] = PAGE_ALIGN(csi_mem_bufsize); cam->vf_bufs_vaddr[0] = (void *)dma_alloc_coherent(0, cam->vf_bufs_size[0], (dma_addr_t *) & cam->vf_bufs[0], GFP_DMA | GFP_KERNEL); if (cam->vf_bufs_vaddr[0] == NULL) { printk(KERN_ERR "Error to allocate vf buffer\n"); err = -ENOMEM; goto out_2; } cam->vf_bufs_size[1] = PAGE_ALIGN(csi_mem_bufsize); cam->vf_bufs_vaddr[1] = (void *)dma_alloc_coherent(0, cam->vf_bufs_size[1], (dma_addr_t *) & cam->vf_bufs[1], GFP_DMA | GFP_KERNEL); if (cam->vf_bufs_vaddr[1] == NULL) { printk(KERN_ERR "Error to allocate vf buffer\n"); err = -ENOMEM; goto out_1; } pr_debug("vf_bufs %x %x\n", cam->vf_bufs[0], cam->vf_bufs[1]); err = ipu_init_channel(cam->ipu, CSI_MEM, ¶ms); if (err != 0) { printk(KERN_ERR "ipu_init_channel %d\n", err); goto out_1; } if ((cam->crop_current.width == cam->win.w.width) && (cam->crop_current.height == cam->win.w.height) && (vf_out_format == IPU_PIX_FMT_NV12) && (cam->rotation < IPU_ROTATE_VERT_FLIP)) { err = ipu_init_channel_buffer(cam->ipu, CSI_MEM, IPU_OUTPUT_BUFFER, IPU_PIX_FMT_NV12, cam->crop_current.width, cam->crop_current.height, cam->crop_current.width, IPU_ROTATE_NONE, fbi->fix.smem_start + (fbi->fix.line_length * fbvar.yres), fbi->fix.smem_start, 0, cam->offset.u_offset, cam->offset.u_offset); } else { err = ipu_init_channel_buffer(cam->ipu, CSI_MEM, IPU_OUTPUT_BUFFER, IPU_PIX_FMT_NV12, cam->crop_current.width, cam->crop_current.height, cam->crop_current.width, IPU_ROTATE_NONE, cam->vf_bufs[0], cam->vf_bufs[1], 0, cam->offset.u_offset, cam->offset.u_offset); } if (err != 0) { printk(KERN_ERR "CSI_MEM output buffer\n"); goto out_1; } err = ipu_enable_channel(cam->ipu, CSI_MEM); if (err < 0) { printk(KERN_ERR "ipu_enable_channel CSI_MEM\n"); goto out_1; } csi_buffer_num = 0; ipu_select_buffer(cam->ipu, CSI_MEM, IPU_OUTPUT_BUFFER, 0); ipu_select_buffer(cam->ipu, CSI_MEM, IPU_OUTPUT_BUFFER, 1); return err; out_1: if (cam->vf_bufs_vaddr[0]) { dma_free_coherent(0, cam->vf_bufs_size[0], cam->vf_bufs_vaddr[0], (dma_addr_t) cam->vf_bufs[0]); cam->vf_bufs_vaddr[0] = NULL; cam->vf_bufs[0] = 0; } if (cam->vf_bufs_vaddr[1]) { dma_free_coherent(0, cam->vf_bufs_size[1], cam->vf_bufs_vaddr[1], (dma_addr_t) cam->vf_bufs[1]); cam->vf_bufs_vaddr[1] = NULL; cam->vf_bufs[1] = 0; } out_2: return err; }