/**
* ispresizer_config_size - Configures input and output image size.
* @pipe: Resizer data path parameters.
*
* Configures the appropriate values stored in the isp_res structure in the
* resizer registers.
*
* Returns 0 if successful, or -EINVAL if passed values haven't been verified
* with ispresizer_try_size() previously.
**/
int ispresizer_s_pipeline(struct isp_res_device *isp_res,
struct isp_node *pipe)
{
struct device *dev = to_device(isp_res);
int bpp = ISP_BYTES_PER_PIXEL;
ispresizer_set_source(isp_res, pipe->in.path);
ispresizer_set_intype(isp_res, pipe->in.path);
ispresizer_set_start_phase(dev, NULL);
ispresizer_set_luma_enhance(dev, NULL);
if (pipe->in.image.pixelformat == V4L2_PIX_FMT_YUYV)
ispresizer_config_ycpos(isp_res, 1);
else
ispresizer_config_ycpos(isp_res, 0);
ispresizer_try_pipeline(isp_res, pipe);
ispresizer_set_ratio(dev, isp_res->h_resz, isp_res->v_resz);
ispresizer_set_coeffs(dev, NULL, isp_res->h_resz, isp_res->v_resz);
/* Switch filter, releated to up/down scale */
if (ispresizer_is_upscale(pipe))
ispresizer_enable_cbilin(isp_res, 1);
else
ispresizer_enable_cbilin(isp_res, 0);
/* Set input and output size */
ispresizer_set_input_size(dev, isp_res->phy_rect.width,
isp_res->phy_rect.height);
ispresizer_set_output_size(dev, pipe->out.image.width,
pipe->out.image.height);
/* Set input address and line offset address */
if (pipe->in.path != RSZ_OTFLY_YUV) {
/* Set the input address, plus calculated crop offset */
ispresizer_set_inaddr(isp_res, isp_res->in_buff_addr, pipe);
/* Set the input line offset/length */
ispresizer_set_in_offset(isp_res, pipe->in.image.bytesperline);
} else {
/* Set the input address.*/
ispresizer_set_inaddr(isp_res, 0, NULL);
/* Set the starting pixel offset */
ispresizer_set_start(dev, isp_res->phy_rect.left * bpp,
isp_res->phy_rect.top);
ispresizer_set_in_offset(isp_res, 0);
}
/* Set output line offset */
ispresizer_set_out_offset(isp_res, pipe->out.image.bytesperline);
return 0;
}
/**
* ispresizer_config_datapath - Specifies which input to use in resizer module
* @input: Indicates the module that gives the image to resizer.
*
* Sets up the default resizer configuration according to the arguments.
*
* Returns 0 if successful, or -1 if an unsupported input was requested.
**/
int ispresizer_config_datapath(enum ispresizer_input input)
{
u32 cnt = 0;
DPRINTK_ISPRESZ("ispresizer_config_datapath()+\n");
ispres_obj.resinput = input;
switch (input) {
case RSZ_OTFLY_YUV:
cnt &= ~ISPRSZ_CNT_INPTYP;
cnt &= ~ISPRSZ_CNT_INPSRC;
ispresizer_set_inaddr(0);
ispresizer_config_inlineoffset(0);
break;
case RSZ_MEM_YUV:
cnt |= ISPRSZ_CNT_INPSRC;
cnt &= ~ISPRSZ_CNT_INPTYP;
break;
case RSZ_MEM_COL8:
cnt |= ISPRSZ_CNT_INPSRC;
cnt |= ISPRSZ_CNT_INPTYP;
break;
default:
DPRINTK_ISPRESZ( "ISP_ERR : Wrong Input\n");
return -1;
}
isp_reg_or(OMAP3_ISP_IOMEM_RESZ, ISPRSZ_CNT, cnt);
//ispresizer_config_ycpos(0);
ispresizer_config_ycpos(1);
ispresizer_config_filter_coef(&ispreszdefcoef);
ispresizer_enable_cbilin(0);
ispresizer_config_luma_enhance(&ispreszdefaultyenh);
DPRINTK_ISPRESZ("ispresizer_config_datapath()-\n");
return 0;
}
/**
* ispresizer_config_datapath - Specifies which input to use in resizer module
* @input: Indicates the module that gives the image to resizer.
*
* Sets up the default resizer configuration according to the arguments.
*
* Returns 0 if successful, or -EINVAL if an unsupported input was requested.
**/
int ispresizer_config_datapath(enum ispresizer_input input)
{
u32 cnt = 0;
DPRINTK_ISPRESZ("ispresizer_config_datapath()+\n");
ispres_obj.resinput = input;
switch (input) {
case RSZ_OTFLY_YUV:
cnt &= ~ISPRSZ_CNT_INPTYP;
cnt &= ~ISPRSZ_CNT_INPSRC;
ispresizer_set_inaddr(0);
ispresizer_config_inlineoffset(0);
break;
case RSZ_MEM_YUV:
cnt |= ISPRSZ_CNT_INPSRC;
cnt &= ~ISPRSZ_CNT_INPTYP;
break;
case RSZ_MEM_COL8:
cnt |= ISPRSZ_CNT_INPSRC;
cnt |= ISPRSZ_CNT_INPTYP;
break;
default:
printk(KERN_ERR "ISP_ERR : Wrong Input\n");
return -EINVAL;
}
isp_reg_or(OMAP3_ISP_IOMEM_RESZ, ISPRSZ_CNT, cnt);
/* Use bilinear interpolation for upsampling per TRM */
if (ispres_obj.outputwidth > ispres_obj.inputwidth)
ispresizer_enable_cbilin(1);
else
ispresizer_enable_cbilin(0);
ispresizer_config_ycpos(0);
ispresizer_config_filter_coef(&ispreszdefcoef);
ispresizer_config_luma_enhance(&ispreszdefaultyenh);
DPRINTK_ISPRESZ("ispresizer_config_datapath()-\n");
return 0;
}
int isp_resize_mem_data(struct isp_mem_resize_data *data)
{
int i;
int ret = -1;
struct isp_mem_resize_data *presizer_user = \
(struct isp_mem_resize_data *)data;
u32 input_buffer_size, output_buffer_size;
u32 input_nr_pages, output_nr_pages;
struct page **input_pages = NULL;
struct page **output_pages = NULL;
unsigned long isp_addr_in = 0;
unsigned long isp_addr_out = 0;
struct isp_mem_resize_data resizer_param;
unsigned long timeout;
if (presizer_user == NULL) {
printk(KERN_ERR "ISP_RESZ_ERR : Invalid user data\n");
return -EINVAL;
}
memcpy(&resizer_param, presizer_user, \
sizeof(struct isp_mem_resize_data));
DPRINTK_ISPPROC("\nRSZ input(%d-%d) - output(%d-%d)\n",
resizer_param.input_width,
resizer_param.input_height,
resizer_param.output_width,
resizer_param.output_height);
DPRINTK_ISPPROC("RSZ start(%d-%d) - end(%d-%d)\n",
resizer_param.left,
resizer_param.top,
resizer_param.crop_width,
resizer_param.crop_height);
if (presizer_user->datain == 0 || presizer_user->dataout == 0)
return -EINVAL;
ispresizer_enable(0);
timeout = jiffies + msecs_to_jiffies(200);
while (ispresizer_busy()) {
if (time_after(jiffies, timeout))
return -EINVAL;
msleep(1);
}
ispresizer_save_context();
ispresizer_free();
ispresizer_request();
/* set data path before configuring modules. */
ispresizer_config_datapath(RSZ_MEM_YUV, 0);
input_buffer_size = ALIGN_TO(presizer_user->input_width* \
presizer_user->input_height*2 , 0x100);
input_pages = map_user_memory_to_kernel(presizer_user->datain,
input_buffer_size, &input_nr_pages);
if (input_pages == NULL) {
ret = -EINVAL;
printk(KERN_ERR "ISP_RESZ_ERR: memory allocation failed\n");
goto exit_cleanup;
}
output_buffer_size = ALIGN_TO(presizer_user->output_width* \
presizer_user->output_height*2, 0x1000);
output_pages = map_user_memory_to_kernel(presizer_user->dataout,
output_buffer_size, &output_nr_pages);
if (output_pages == NULL) {
ret = -EINVAL;
printk(KERN_ERR "ISP_RESZ_ERR: memory allocation failed\n");
goto exit_cleanup;
}
for (i = 0; i < output_nr_pages; ++i)
flush_dcache_page(output_pages[i]);
isp_addr_in = ispmmu_vmap_pages(input_pages, input_nr_pages);
if (IS_ERR((void *)isp_addr_in)) {
isp_addr_in = 0;
ret = -EINVAL;
printk(KERN_ERR "ISP_RESZ_ERR: isp mmu map failed\n");
goto exit_cleanup;
}
isp_addr_out = ispmmu_vmap_pages(output_pages, output_nr_pages);
if (IS_ERR((void *)isp_addr_out)) {
isp_addr_out = 0;
ret = -EINVAL;
printk(KERN_ERR "ISP_RESZ_ERR: isp mmu map failed\n");
goto exit_cleanup;
}
if ((resizer_param.left == 0) && (resizer_param.top == 0)) {
ret = ispresizer_try_size(&resizer_param.input_width,
&resizer_param.input_height,
&resizer_param.output_width,
&resizer_param.output_height);
ret = ispresizer_config_size(resizer_param.input_width,
resizer_param.input_height,
resizer_param.output_width,
resizer_param.output_height);
ispresizer_set_inaddr(isp_addr_in);
} else {
ispresizer_trycrop(resizer_param.left,
resizer_param.top,
resizer_param.crop_width,
resizer_param.crop_height,
resizer_param.output_width,
resizer_param.output_height);
ispresizer_applycrop();
/*pixel alignment in 32bit space, vertical must be 0 per TRM */
isp_reg_writel(((resizer_param.left%16) <<
ISPRSZ_IN_START_HORZ_ST_SHIFT) |
(0 <<
ISPRSZ_IN_START_VERT_ST_SHIFT),
OMAP3_ISP_IOMEM_RESZ,
ISPRSZ_IN_START);
/* Align input address for cropping, per TRM */
ispresizer_set_inaddr(isp_addr_in +
(resizer_param.top*resizer_param.input_width*2)
+ ((resizer_param.left/16)*32));
}
ispresizer_set_inaddr(isp_addr_in);
ispresizer_set_outaddr(isp_addr_out);
ispresizer_config_ycpos(0);
ispresizer_config_inlineoffset(
ALIGN_TO(presizer_user->input_width*2, 32));
isp_set_callback(CBK_RESZ_DONE, rsz_isr, (void *) NULL, (void *)NULL);
isp_reg_writel(0xFFFFFFFF, OMAP3_ISP_IOMEM_MAIN, ISP_IRQ0STATUS);
isp_wfc.done = 0;
/* start resizer engine. */
ispresizer_enable(1);
ret = wait_for_completion_timeout(&isp_wfc, msecs_to_jiffies(1000));
if (!ret)
ispresizer_enable(0);
timeout = jiffies + msecs_to_jiffies(50);
while (ispresizer_busy()) {
msleep(5);
if (time_after(jiffies, timeout)) {
printk(KERN_ERR "ISP_RESZ_ERR: Resizer still busy");
break;
}
}
isp_reg_writel(0xFFFFFFFF, OMAP3_ISP_IOMEM_MAIN, ISP_IRQ0STATUS);
isp_unset_callback(CBK_RESZ_DONE);
ret = 0;
exit_cleanup:
ispresizer_restore_context();
if (isp_addr_in != 0)
ispmmu_vunmap(isp_addr_in);
if (isp_addr_out != 0)
ispmmu_vunmap(isp_addr_out);
if (input_pages != NULL) {
unmap_user_memory_from_kernel(input_pages, input_nr_pages);
kfree(input_pages);
}
if (output_pages != NULL) {
unmap_user_memory_from_kernel(output_pages, output_nr_pages);
kfree(output_pages);
}
DPRINTK_ISPPROC("resizer exit.\n");
return ret;
}
