int s3cfb_direct_ioctl(int id, unsigned int cmd, unsigned long arg)
{
struct s3cfb_global *fbdev = get_fimd_global(id);
struct fb_info *fb = fbdev->fb[id];
struct fb_var_screeninfo *var = &fb->var;
struct fb_fix_screeninfo *fix = &fb->fix;
struct s3cfb_window *win = fb->par;
struct s3cfb_lcd *lcd = fbdev->lcd;
struct s3cfb_user_window user_win;
void *argp = (void *)arg;
int ret = 0;
switch (cmd) {
case FBIOGET_FSCREENINFO:
ret = memcpy(argp, &fb->fix, sizeof(fb->fix)) ? 0 : -EFAULT;
break;
case FBIOGET_VSCREENINFO:
ret = memcpy(argp, &fb->var, sizeof(fb->var)) ? 0 : -EFAULT;
break;
case FBIOPUT_VSCREENINFO:
ret = s3cfb_check_var((struct fb_var_screeninfo *)argp, fb);
if (ret) {
dev_err(fbdev->dev, "invalid vscreeninfo\n");
break;
}
ret = memcpy(&fb->var, (struct fb_var_screeninfo *)argp,
sizeof(fb->var)) ? 0 : -EFAULT;
if (ret) {
dev_err(fbdev->dev, "failed to put new vscreeninfo\n");
break;
}
fix->line_length = var->xres_virtual * var->bits_per_pixel / 8;
fix->smem_len = fix->line_length * var->yres_virtual;
s3cfb_set_win_params(fbdev, id);
break;
case S3CFB_WIN_POSITION:
ret = memcpy(&user_win, (struct s3cfb_user_window __user *)arg,
sizeof(user_win)) ? 0 : -EFAULT;
if (ret) {
dev_err(fbdev->dev, "failed to S3CFB_WIN_POSITION\n");
break;
}
if (user_win.x < 0)
user_win.x = 0;
if (user_win.y < 0)
user_win.y = 0;
if (user_win.x + var->xres > lcd->width)
win->x = lcd->width - var->xres;
else
win->x = user_win.x;
if (user_win.y + var->yres > lcd->height)
win->y = lcd->height - var->yres;
else
win->y = user_win.y;
s3cfb_set_window_position(fbdev, win->id);
break;
case S3CFB_GET_LCD_WIDTH:
ret = memcpy(argp, &lcd->width, sizeof(int)) ? 0 : -EFAULT;
if (ret) {
dev_err(fbdev->dev, "failed to S3CFB_GET_LCD_WIDTH\n");
break;
}
break;
case S3CFB_GET_LCD_HEIGHT:
ret = memcpy(argp, &lcd->height, sizeof(int)) ? 0 : -EFAULT;
if (ret) {
dev_err(fbdev->dev, "failed to S3CFB_GET_LCD_HEIGHT\n");
break;
}
break;
case S3CFB_SET_WRITEBACK:
if ((u32)argp == 1)
fbdev->output = OUTPUT_WB_RGB;
else
fbdev->output = OUTPUT_RGB;
s3cfb_set_output(fbdev);
break;
case S3CFB_SET_WIN_ON:
s3cfb_enable_window(fbdev, id);
break;
case S3CFB_SET_WIN_OFF:
s3cfb_disable_window(fbdev, id);
break;
case S3CFB_SET_WIN_PATH:
win->path = (enum s3cfb_data_path_t)argp;
break;
case S3CFB_SET_WIN_ADDR:
fix->smem_start = (unsigned long)argp;
s3cfb_set_buffer_address(fbdev, id);
break;
case S3CFB_SET_WIN_MEM:
win->owner = (enum s3cfb_mem_owner_t)argp;
break;
case S3CFB_SET_VSYNC_INT:
if (argp)
s3cfb_set_global_interrupt(fbdev, 1);
s3cfb_set_vsync_interrupt(fbdev, (int)argp);
break;
case S3CFB_GET_VSYNC_INT_STATUS:
ret = s3cfb_get_vsync_interrupt(fbdev);
break;
default:
ret = s3cfb_ioctl(fb, cmd, arg);
break;
}
return ret;
}
int s3cfb_direct_ioctl(int id, unsigned int cmd, unsigned long arg)
{
struct fb_info *fb = ctrl->fb[id];
struct fb_var_screeninfo *var = &fb->var;
struct s3cfb_window *win = fb->par;
struct s3cfb_lcd *lcd = ctrl->lcd;
struct s3cfb_user_window user_win;
void *argp = (void *) arg;
int ret = 0;
switch (cmd) {
case FBIO_ALLOC:
win->path = (enum s3cfb_data_path_t) argp;
break;
case FBIOGET_FSCREENINFO:
ret = memcpy(argp, &fb->fix, sizeof(fb->fix)) ? 0 : -EFAULT;
break;
case FBIOGET_VSCREENINFO:
ret = memcpy(argp, &fb->var, sizeof(fb->var)) ? 0 : -EFAULT;
break;
case FBIOPUT_VSCREENINFO:
ret = s3cfb_check_var((struct fb_var_screeninfo *) argp, fb);
if (ret) {
dev_err(ctrl->dev, "invalid vscreeninfo\n");
break;
}
ret = memcpy(&fb->var, (struct fb_var_screeninfo *) argp,
sizeof(fb->var)) ? 0 : -EFAULT;
if (ret) {
dev_err(ctrl->dev, "failed to put new vscreeninfo\n");
break;
}
ret = s3cfb_set_par(fb);
break;
case S3CFB_WIN_POSITION:
ret = memcpy(&user_win, (struct s3cfb_user_window __user *) arg,
sizeof(user_win)) ? 0 : -EFAULT;
if (ret) {
dev_err(ctrl->dev, "failed to S3CFB_WIN_POSITION.\n");
break;
}
if (user_win.x < 0)
user_win.x = 0;
if (user_win.y < 0)
user_win.y = 0;
if (user_win.x + var->xres > lcd->width)
win->x = lcd->width - var->xres;
else
win->x = user_win.x;
if (user_win.y + var->yres > lcd->height)
win->y = lcd->height - var->yres;
else
win->y = user_win.y;
s3cfb_set_window_position(ctrl, win->id);
break;
case S3CFB_SET_SUSPEND_FIFO:
win->suspend_fifo = argp;
break;
case S3CFB_SET_RESUME_FIFO:
win->resume_fifo = argp;
break;
/*
* for FBIO_WAITFORVSYNC
*/
default:
ret = s3cfb_ioctl(fb, cmd, arg);
break;
}
return ret;
}