1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Samsung EXYNOS4x12 FIMC-IS (Imaging Subsystem) driver 4 * 5 * Copyright (C) 2013 Samsung Electronics Co., Ltd. 6 * 7 * Authors: Younghwan Joo <yhwan.joo@samsung.com> 8 * Sylwester Nawrocki <s.nawrocki@samsung.com> 9 */ 10 #define pr_fmt(fmt) "%s:%d " fmt, __func__, __LINE__ 11 12 #include <linux/bitops.h> 13 #include <linux/bug.h> 14 #include <linux/device.h> 15 #include <linux/errno.h> 16 #include <linux/kernel.h> 17 #include <linux/module.h> 18 #include <linux/platform_device.h> 19 #include <linux/slab.h> 20 #include <linux/types.h> 21 #include <linux/videodev2.h> 22 23 #include <media/v4l2-device.h> 24 #include <media/v4l2-ioctl.h> 25 26 #include "fimc-is.h" 27 #include "fimc-is-command.h" 28 #include "fimc-is-errno.h" 29 #include "fimc-is-param.h" 30 #include "fimc-is-regs.h" 31 #include "fimc-is-sensor.h" 32 __hw_param_copy(void * dst,void * src)33 static void __hw_param_copy(void *dst, void *src) 34 { 35 memcpy(dst, src, FIMC_IS_PARAM_MAX_SIZE); 36 } 37 __fimc_is_hw_update_param_global_shotmode(struct fimc_is * is)38 static void __fimc_is_hw_update_param_global_shotmode(struct fimc_is *is) 39 { 40 struct param_global_shotmode *dst, *src; 41 42 dst = &is->is_p_region->parameter.global.shotmode; 43 src = &is->config[is->config_index].global.shotmode; 44 __hw_param_copy(dst, src); 45 } 46 __fimc_is_hw_update_param_sensor_framerate(struct fimc_is * is)47 static void __fimc_is_hw_update_param_sensor_framerate(struct fimc_is *is) 48 { 49 struct param_sensor_framerate *dst, *src; 50 51 dst = &is->is_p_region->parameter.sensor.frame_rate; 52 src = &is->config[is->config_index].sensor.frame_rate; 53 __hw_param_copy(dst, src); 54 } 55 __fimc_is_hw_update_param(struct fimc_is * is,u32 offset)56 int __fimc_is_hw_update_param(struct fimc_is *is, u32 offset) 57 { 58 struct is_param_region *par = &is->is_p_region->parameter; 59 struct chain_config *cfg = &is->config[is->config_index]; 60 61 switch (offset) { 62 case PARAM_ISP_CONTROL: 63 __hw_param_copy(&par->isp.control, &cfg->isp.control); 64 break; 65 66 case PARAM_ISP_OTF_INPUT: 67 __hw_param_copy(&par->isp.otf_input, &cfg->isp.otf_input); 68 break; 69 70 case PARAM_ISP_DMA1_INPUT: 71 __hw_param_copy(&par->isp.dma1_input, &cfg->isp.dma1_input); 72 break; 73 74 case PARAM_ISP_DMA2_INPUT: 75 __hw_param_copy(&par->isp.dma2_input, &cfg->isp.dma2_input); 76 break; 77 78 case PARAM_ISP_AA: 79 __hw_param_copy(&par->isp.aa, &cfg->isp.aa); 80 break; 81 82 case PARAM_ISP_FLASH: 83 __hw_param_copy(&par->isp.flash, &cfg->isp.flash); 84 break; 85 86 case PARAM_ISP_AWB: 87 __hw_param_copy(&par->isp.awb, &cfg->isp.awb); 88 break; 89 90 case PARAM_ISP_IMAGE_EFFECT: 91 __hw_param_copy(&par->isp.effect, &cfg->isp.effect); 92 break; 93 94 case PARAM_ISP_ISO: 95 __hw_param_copy(&par->isp.iso, &cfg->isp.iso); 96 break; 97 98 case PARAM_ISP_ADJUST: 99 __hw_param_copy(&par->isp.adjust, &cfg->isp.adjust); 100 break; 101 102 case PARAM_ISP_METERING: 103 __hw_param_copy(&par->isp.metering, &cfg->isp.metering); 104 break; 105 106 case PARAM_ISP_AFC: 107 __hw_param_copy(&par->isp.afc, &cfg->isp.afc); 108 break; 109 110 case PARAM_ISP_OTF_OUTPUT: 111 __hw_param_copy(&par->isp.otf_output, &cfg->isp.otf_output); 112 break; 113 114 case PARAM_ISP_DMA1_OUTPUT: 115 __hw_param_copy(&par->isp.dma1_output, &cfg->isp.dma1_output); 116 break; 117 118 case PARAM_ISP_DMA2_OUTPUT: 119 __hw_param_copy(&par->isp.dma2_output, &cfg->isp.dma2_output); 120 break; 121 122 case PARAM_DRC_CONTROL: 123 __hw_param_copy(&par->drc.control, &cfg->drc.control); 124 break; 125 126 case PARAM_DRC_OTF_INPUT: 127 __hw_param_copy(&par->drc.otf_input, &cfg->drc.otf_input); 128 break; 129 130 case PARAM_DRC_DMA_INPUT: 131 __hw_param_copy(&par->drc.dma_input, &cfg->drc.dma_input); 132 break; 133 134 case PARAM_DRC_OTF_OUTPUT: 135 __hw_param_copy(&par->drc.otf_output, &cfg->drc.otf_output); 136 break; 137 138 case PARAM_FD_CONTROL: 139 __hw_param_copy(&par->fd.control, &cfg->fd.control); 140 break; 141 142 case PARAM_FD_OTF_INPUT: 143 __hw_param_copy(&par->fd.otf_input, &cfg->fd.otf_input); 144 break; 145 146 case PARAM_FD_DMA_INPUT: 147 __hw_param_copy(&par->fd.dma_input, &cfg->fd.dma_input); 148 break; 149 150 case PARAM_FD_CONFIG: 151 __hw_param_copy(&par->fd.config, &cfg->fd.config); 152 break; 153 154 default: 155 return -EINVAL; 156 } 157 158 return 0; 159 } 160 __get_pending_param_count(struct fimc_is * is)161 unsigned int __get_pending_param_count(struct fimc_is *is) 162 { 163 struct chain_config *config = &is->config[is->config_index]; 164 unsigned long flags; 165 unsigned int count; 166 167 spin_lock_irqsave(&is->slock, flags); 168 count = hweight32(config->p_region_index[0]); 169 count += hweight32(config->p_region_index[1]); 170 spin_unlock_irqrestore(&is->slock, flags); 171 172 return count; 173 } 174 __is_hw_update_params(struct fimc_is * is)175 int __is_hw_update_params(struct fimc_is *is) 176 { 177 unsigned long *p_index; 178 int i, id, ret = 0; 179 180 id = is->config_index; 181 p_index = &is->config[id].p_region_index[0]; 182 183 if (test_bit(PARAM_GLOBAL_SHOTMODE, p_index)) 184 __fimc_is_hw_update_param_global_shotmode(is); 185 186 if (test_bit(PARAM_SENSOR_FRAME_RATE, p_index)) 187 __fimc_is_hw_update_param_sensor_framerate(is); 188 189 for (i = PARAM_ISP_CONTROL; i < PARAM_DRC_CONTROL; i++) { 190 if (test_bit(i, p_index)) 191 ret = __fimc_is_hw_update_param(is, i); 192 } 193 194 for (i = PARAM_DRC_CONTROL; i < PARAM_SCALERC_CONTROL; i++) { 195 if (test_bit(i, p_index)) 196 ret = __fimc_is_hw_update_param(is, i); 197 } 198 199 for (i = PARAM_FD_CONTROL; i <= PARAM_FD_CONFIG; i++) { 200 if (test_bit(i, p_index)) 201 ret = __fimc_is_hw_update_param(is, i); 202 } 203 204 return ret; 205 } 206 __is_get_frame_size(struct fimc_is * is,struct v4l2_mbus_framefmt * mf)207 void __is_get_frame_size(struct fimc_is *is, struct v4l2_mbus_framefmt *mf) 208 { 209 struct isp_param *isp; 210 211 isp = &is->config[is->config_index].isp; 212 mf->width = isp->otf_input.width; 213 mf->height = isp->otf_input.height; 214 } 215 __is_set_frame_size(struct fimc_is * is,struct v4l2_mbus_framefmt * mf)216 void __is_set_frame_size(struct fimc_is *is, struct v4l2_mbus_framefmt *mf) 217 { 218 unsigned int index = is->config_index; 219 struct isp_param *isp; 220 struct drc_param *drc; 221 struct fd_param *fd; 222 223 isp = &is->config[index].isp; 224 drc = &is->config[index].drc; 225 fd = &is->config[index].fd; 226 227 /* Update isp size info (OTF only) */ 228 isp->otf_input.width = mf->width; 229 isp->otf_input.height = mf->height; 230 isp->otf_output.width = mf->width; 231 isp->otf_output.height = mf->height; 232 /* Update drc size info (OTF only) */ 233 drc->otf_input.width = mf->width; 234 drc->otf_input.height = mf->height; 235 drc->otf_output.width = mf->width; 236 drc->otf_output.height = mf->height; 237 /* Update fd size info (OTF only) */ 238 fd->otf_input.width = mf->width; 239 fd->otf_input.height = mf->height; 240 241 if (test_bit(PARAM_ISP_OTF_INPUT, 242 &is->config[index].p_region_index[0])) 243 return; 244 245 /* Update field */ 246 fimc_is_set_param_bit(is, PARAM_ISP_OTF_INPUT); 247 fimc_is_set_param_bit(is, PARAM_ISP_OTF_OUTPUT); 248 fimc_is_set_param_bit(is, PARAM_DRC_OTF_INPUT); 249 fimc_is_set_param_bit(is, PARAM_DRC_OTF_OUTPUT); 250 fimc_is_set_param_bit(is, PARAM_FD_OTF_INPUT); 251 } 252 fimc_is_hw_get_sensor_max_framerate(struct fimc_is * is)253 int fimc_is_hw_get_sensor_max_framerate(struct fimc_is *is) 254 { 255 switch (is->sensor->drvdata->id) { 256 case FIMC_IS_SENSOR_ID_S5K6A3: 257 return 30; 258 default: 259 return 15; 260 } 261 } 262 __is_set_sensor(struct fimc_is * is,int fps)263 void __is_set_sensor(struct fimc_is *is, int fps) 264 { 265 unsigned int index = is->config_index; 266 struct sensor_param *sensor; 267 struct isp_param *isp; 268 269 sensor = &is->config[index].sensor; 270 isp = &is->config[index].isp; 271 272 if (fps == 0) { 273 sensor->frame_rate.frame_rate = 274 fimc_is_hw_get_sensor_max_framerate(is); 275 isp->otf_input.frametime_min = 0; 276 isp->otf_input.frametime_max = 66666; 277 } else { 278 sensor->frame_rate.frame_rate = fps; 279 isp->otf_input.frametime_min = 0; 280 isp->otf_input.frametime_max = (u32)1000000 / fps; 281 } 282 283 fimc_is_set_param_bit(is, PARAM_SENSOR_FRAME_RATE); 284 fimc_is_set_param_bit(is, PARAM_ISP_OTF_INPUT); 285 } 286 __is_set_init_isp_aa(struct fimc_is * is)287 static void __maybe_unused __is_set_init_isp_aa(struct fimc_is *is) 288 { 289 struct isp_param *isp; 290 291 isp = &is->config[is->config_index].isp; 292 293 isp->aa.cmd = ISP_AA_COMMAND_START; 294 isp->aa.target = ISP_AA_TARGET_AF | ISP_AA_TARGET_AE | 295 ISP_AA_TARGET_AWB; 296 isp->aa.mode = 0; 297 isp->aa.scene = 0; 298 isp->aa.sleep = 0; 299 isp->aa.face = 0; 300 isp->aa.touch_x = 0; 301 isp->aa.touch_y = 0; 302 isp->aa.manual_af_setting = 0; 303 isp->aa.err = ISP_AF_ERROR_NONE; 304 305 fimc_is_set_param_bit(is, PARAM_ISP_AA); 306 } 307 __is_set_isp_flash(struct fimc_is * is,u32 cmd,u32 redeye)308 void __is_set_isp_flash(struct fimc_is *is, u32 cmd, u32 redeye) 309 { 310 unsigned int index = is->config_index; 311 struct isp_param *isp = &is->config[index].isp; 312 313 isp->flash.cmd = cmd; 314 isp->flash.redeye = redeye; 315 isp->flash.err = ISP_FLASH_ERROR_NONE; 316 317 fimc_is_set_param_bit(is, PARAM_ISP_FLASH); 318 } 319 __is_set_isp_awb(struct fimc_is * is,u32 cmd,u32 val)320 void __is_set_isp_awb(struct fimc_is *is, u32 cmd, u32 val) 321 { 322 unsigned int index = is->config_index; 323 struct isp_param *isp; 324 325 isp = &is->config[index].isp; 326 327 isp->awb.cmd = cmd; 328 isp->awb.illumination = val; 329 isp->awb.err = ISP_AWB_ERROR_NONE; 330 331 fimc_is_set_param_bit(is, PARAM_ISP_AWB); 332 } 333 __is_set_isp_effect(struct fimc_is * is,u32 cmd)334 void __is_set_isp_effect(struct fimc_is *is, u32 cmd) 335 { 336 unsigned int index = is->config_index; 337 struct isp_param *isp; 338 339 isp = &is->config[index].isp; 340 341 isp->effect.cmd = cmd; 342 isp->effect.err = ISP_IMAGE_EFFECT_ERROR_NONE; 343 344 fimc_is_set_param_bit(is, PARAM_ISP_IMAGE_EFFECT); 345 } 346 __is_set_isp_iso(struct fimc_is * is,u32 cmd,u32 val)347 void __is_set_isp_iso(struct fimc_is *is, u32 cmd, u32 val) 348 { 349 unsigned int index = is->config_index; 350 struct isp_param *isp; 351 352 isp = &is->config[index].isp; 353 354 isp->iso.cmd = cmd; 355 isp->iso.value = val; 356 isp->iso.err = ISP_ISO_ERROR_NONE; 357 358 fimc_is_set_param_bit(is, PARAM_ISP_ISO); 359 } 360 __is_set_isp_adjust(struct fimc_is * is,u32 cmd,u32 val)361 void __is_set_isp_adjust(struct fimc_is *is, u32 cmd, u32 val) 362 { 363 unsigned int index = is->config_index; 364 unsigned long *p_index; 365 struct isp_param *isp; 366 367 p_index = &is->config[index].p_region_index[0]; 368 isp = &is->config[index].isp; 369 370 switch (cmd) { 371 case ISP_ADJUST_COMMAND_MANUAL_CONTRAST: 372 isp->adjust.contrast = val; 373 break; 374 case ISP_ADJUST_COMMAND_MANUAL_SATURATION: 375 isp->adjust.saturation = val; 376 break; 377 case ISP_ADJUST_COMMAND_MANUAL_SHARPNESS: 378 isp->adjust.sharpness = val; 379 break; 380 case ISP_ADJUST_COMMAND_MANUAL_EXPOSURE: 381 isp->adjust.exposure = val; 382 break; 383 case ISP_ADJUST_COMMAND_MANUAL_BRIGHTNESS: 384 isp->adjust.brightness = val; 385 break; 386 case ISP_ADJUST_COMMAND_MANUAL_HUE: 387 isp->adjust.hue = val; 388 break; 389 case ISP_ADJUST_COMMAND_AUTO: 390 isp->adjust.contrast = 0; 391 isp->adjust.saturation = 0; 392 isp->adjust.sharpness = 0; 393 isp->adjust.exposure = 0; 394 isp->adjust.brightness = 0; 395 isp->adjust.hue = 0; 396 break; 397 } 398 399 if (!test_bit(PARAM_ISP_ADJUST, p_index)) { 400 isp->adjust.cmd = cmd; 401 isp->adjust.err = ISP_ADJUST_ERROR_NONE; 402 fimc_is_set_param_bit(is, PARAM_ISP_ADJUST); 403 } else { 404 isp->adjust.cmd |= cmd; 405 } 406 } 407 __is_set_isp_metering(struct fimc_is * is,u32 id,u32 val)408 void __is_set_isp_metering(struct fimc_is *is, u32 id, u32 val) 409 { 410 unsigned int index = is->config_index; 411 struct isp_param *isp; 412 unsigned long *p_index; 413 414 p_index = &is->config[index].p_region_index[0]; 415 isp = &is->config[index].isp; 416 417 switch (id) { 418 case IS_METERING_CONFIG_CMD: 419 isp->metering.cmd = val; 420 break; 421 case IS_METERING_CONFIG_WIN_POS_X: 422 isp->metering.win_pos_x = val; 423 break; 424 case IS_METERING_CONFIG_WIN_POS_Y: 425 isp->metering.win_pos_y = val; 426 break; 427 case IS_METERING_CONFIG_WIN_WIDTH: 428 isp->metering.win_width = val; 429 break; 430 case IS_METERING_CONFIG_WIN_HEIGHT: 431 isp->metering.win_height = val; 432 break; 433 default: 434 return; 435 } 436 437 if (!test_bit(PARAM_ISP_METERING, p_index)) { 438 isp->metering.err = ISP_METERING_ERROR_NONE; 439 fimc_is_set_param_bit(is, PARAM_ISP_METERING); 440 } 441 } 442 __is_set_isp_afc(struct fimc_is * is,u32 cmd,u32 val)443 void __is_set_isp_afc(struct fimc_is *is, u32 cmd, u32 val) 444 { 445 unsigned int index = is->config_index; 446 struct isp_param *isp; 447 448 isp = &is->config[index].isp; 449 450 isp->afc.cmd = cmd; 451 isp->afc.manual = val; 452 isp->afc.err = ISP_AFC_ERROR_NONE; 453 454 fimc_is_set_param_bit(is, PARAM_ISP_AFC); 455 } 456 __is_set_drc_control(struct fimc_is * is,u32 val)457 void __is_set_drc_control(struct fimc_is *is, u32 val) 458 { 459 unsigned int index = is->config_index; 460 struct drc_param *drc; 461 462 drc = &is->config[index].drc; 463 464 drc->control.bypass = val; 465 466 fimc_is_set_param_bit(is, PARAM_DRC_CONTROL); 467 } 468 __is_set_fd_control(struct fimc_is * is,u32 val)469 void __is_set_fd_control(struct fimc_is *is, u32 val) 470 { 471 unsigned int index = is->config_index; 472 struct fd_param *fd; 473 unsigned long *p_index; 474 475 p_index = &is->config[index].p_region_index[1]; 476 fd = &is->config[index].fd; 477 478 fd->control.cmd = val; 479 480 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) 481 fimc_is_set_param_bit(is, PARAM_FD_CONTROL); 482 } 483 __is_set_fd_config_maxface(struct fimc_is * is,u32 val)484 void __is_set_fd_config_maxface(struct fimc_is *is, u32 val) 485 { 486 unsigned int index = is->config_index; 487 struct fd_param *fd; 488 unsigned long *p_index; 489 490 p_index = &is->config[index].p_region_index[1]; 491 fd = &is->config[index].fd; 492 493 fd->config.max_number = val; 494 495 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 496 fd->config.cmd = FD_CONFIG_COMMAND_MAXIMUM_NUMBER; 497 fd->config.err = ERROR_FD_NONE; 498 fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 499 } else { 500 fd->config.cmd |= FD_CONFIG_COMMAND_MAXIMUM_NUMBER; 501 } 502 } 503 __is_set_fd_config_rollangle(struct fimc_is * is,u32 val)504 void __is_set_fd_config_rollangle(struct fimc_is *is, u32 val) 505 { 506 unsigned int index = is->config_index; 507 struct fd_param *fd; 508 unsigned long *p_index; 509 510 p_index = &is->config[index].p_region_index[1]; 511 fd = &is->config[index].fd; 512 513 fd->config.roll_angle = val; 514 515 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 516 fd->config.cmd = FD_CONFIG_COMMAND_ROLL_ANGLE; 517 fd->config.err = ERROR_FD_NONE; 518 fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 519 } else { 520 fd->config.cmd |= FD_CONFIG_COMMAND_ROLL_ANGLE; 521 } 522 } 523 __is_set_fd_config_yawangle(struct fimc_is * is,u32 val)524 void __is_set_fd_config_yawangle(struct fimc_is *is, u32 val) 525 { 526 unsigned int index = is->config_index; 527 struct fd_param *fd; 528 unsigned long *p_index; 529 530 p_index = &is->config[index].p_region_index[1]; 531 fd = &is->config[index].fd; 532 533 fd->config.yaw_angle = val; 534 535 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 536 fd->config.cmd = FD_CONFIG_COMMAND_YAW_ANGLE; 537 fd->config.err = ERROR_FD_NONE; 538 fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 539 } else { 540 fd->config.cmd |= FD_CONFIG_COMMAND_YAW_ANGLE; 541 } 542 } 543 __is_set_fd_config_smilemode(struct fimc_is * is,u32 val)544 void __is_set_fd_config_smilemode(struct fimc_is *is, u32 val) 545 { 546 unsigned int index = is->config_index; 547 struct fd_param *fd; 548 unsigned long *p_index; 549 550 p_index = &is->config[index].p_region_index[1]; 551 fd = &is->config[index].fd; 552 553 fd->config.smile_mode = val; 554 555 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 556 fd->config.cmd = FD_CONFIG_COMMAND_SMILE_MODE; 557 fd->config.err = ERROR_FD_NONE; 558 fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 559 } else { 560 fd->config.cmd |= FD_CONFIG_COMMAND_SMILE_MODE; 561 } 562 } 563 __is_set_fd_config_blinkmode(struct fimc_is * is,u32 val)564 void __is_set_fd_config_blinkmode(struct fimc_is *is, u32 val) 565 { 566 unsigned int index = is->config_index; 567 struct fd_param *fd; 568 unsigned long *p_index; 569 570 p_index = &is->config[index].p_region_index[1]; 571 fd = &is->config[index].fd; 572 573 fd->config.blink_mode = val; 574 575 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 576 fd->config.cmd = FD_CONFIG_COMMAND_BLINK_MODE; 577 fd->config.err = ERROR_FD_NONE; 578 fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 579 } else { 580 fd->config.cmd |= FD_CONFIG_COMMAND_BLINK_MODE; 581 } 582 } 583 __is_set_fd_config_eyedetect(struct fimc_is * is,u32 val)584 void __is_set_fd_config_eyedetect(struct fimc_is *is, u32 val) 585 { 586 unsigned int index = is->config_index; 587 struct fd_param *fd; 588 unsigned long *p_index; 589 590 p_index = &is->config[index].p_region_index[1]; 591 fd = &is->config[index].fd; 592 593 fd->config.eye_detect = val; 594 595 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 596 fd->config.cmd = FD_CONFIG_COMMAND_EYES_DETECT; 597 fd->config.err = ERROR_FD_NONE; 598 fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 599 } else { 600 fd->config.cmd |= FD_CONFIG_COMMAND_EYES_DETECT; 601 } 602 } 603 __is_set_fd_config_mouthdetect(struct fimc_is * is,u32 val)604 void __is_set_fd_config_mouthdetect(struct fimc_is *is, u32 val) 605 { 606 unsigned int index = is->config_index; 607 struct fd_param *fd; 608 unsigned long *p_index; 609 610 p_index = &is->config[index].p_region_index[1]; 611 fd = &is->config[index].fd; 612 613 fd->config.mouth_detect = val; 614 615 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 616 fd->config.cmd = FD_CONFIG_COMMAND_MOUTH_DETECT; 617 fd->config.err = ERROR_FD_NONE; 618 fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 619 } else { 620 fd->config.cmd |= FD_CONFIG_COMMAND_MOUTH_DETECT; 621 } 622 } 623 __is_set_fd_config_orientation(struct fimc_is * is,u32 val)624 void __is_set_fd_config_orientation(struct fimc_is *is, u32 val) 625 { 626 unsigned int index = is->config_index; 627 struct fd_param *fd; 628 unsigned long *p_index; 629 630 p_index = &is->config[index].p_region_index[1]; 631 fd = &is->config[index].fd; 632 633 fd->config.orientation = val; 634 635 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 636 fd->config.cmd = FD_CONFIG_COMMAND_ORIENTATION; 637 fd->config.err = ERROR_FD_NONE; 638 fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 639 } else { 640 fd->config.cmd |= FD_CONFIG_COMMAND_ORIENTATION; 641 } 642 } 643 __is_set_fd_config_orientation_val(struct fimc_is * is,u32 val)644 void __is_set_fd_config_orientation_val(struct fimc_is *is, u32 val) 645 { 646 unsigned int index = is->config_index; 647 struct fd_param *fd; 648 unsigned long *p_index; 649 650 p_index = &is->config[index].p_region_index[1]; 651 fd = &is->config[index].fd; 652 653 fd->config.orientation_value = val; 654 655 if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 656 fd->config.cmd = FD_CONFIG_COMMAND_ORIENTATION_VALUE; 657 fd->config.err = ERROR_FD_NONE; 658 fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 659 } else { 660 fd->config.cmd |= FD_CONFIG_COMMAND_ORIENTATION_VALUE; 661 } 662 } 663 fimc_is_set_initial_params(struct fimc_is * is)664 void fimc_is_set_initial_params(struct fimc_is *is) 665 { 666 struct global_param *global; 667 struct isp_param *isp; 668 struct drc_param *drc; 669 struct fd_param *fd; 670 unsigned long *p_index; 671 unsigned int index; 672 673 index = is->config_index; 674 global = &is->config[index].global; 675 isp = &is->config[index].isp; 676 drc = &is->config[index].drc; 677 fd = &is->config[index].fd; 678 p_index = &is->config[index].p_region_index[0]; 679 680 /* Global */ 681 global->shotmode.cmd = 1; 682 fimc_is_set_param_bit(is, PARAM_GLOBAL_SHOTMODE); 683 684 /* ISP */ 685 isp->control.cmd = CONTROL_COMMAND_START; 686 isp->control.bypass = CONTROL_BYPASS_DISABLE; 687 isp->control.err = CONTROL_ERROR_NONE; 688 fimc_is_set_param_bit(is, PARAM_ISP_CONTROL); 689 690 isp->otf_input.cmd = OTF_INPUT_COMMAND_ENABLE; 691 if (!test_bit(PARAM_ISP_OTF_INPUT, p_index)) { 692 isp->otf_input.width = DEFAULT_PREVIEW_STILL_WIDTH; 693 isp->otf_input.height = DEFAULT_PREVIEW_STILL_HEIGHT; 694 fimc_is_set_param_bit(is, PARAM_ISP_OTF_INPUT); 695 } 696 if (is->sensor->test_pattern) 697 isp->otf_input.format = OTF_INPUT_FORMAT_STRGEN_COLORBAR_BAYER; 698 else 699 isp->otf_input.format = OTF_INPUT_FORMAT_BAYER; 700 isp->otf_input.bitwidth = 10; 701 isp->otf_input.order = OTF_INPUT_ORDER_BAYER_GR_BG; 702 isp->otf_input.crop_offset_x = 0; 703 isp->otf_input.crop_offset_y = 0; 704 isp->otf_input.err = OTF_INPUT_ERROR_NONE; 705 706 isp->dma1_input.cmd = DMA_INPUT_COMMAND_DISABLE; 707 isp->dma1_input.width = 0; 708 isp->dma1_input.height = 0; 709 isp->dma1_input.format = 0; 710 isp->dma1_input.bitwidth = 0; 711 isp->dma1_input.plane = 0; 712 isp->dma1_input.order = 0; 713 isp->dma1_input.buffer_number = 0; 714 isp->dma1_input.width = 0; 715 isp->dma1_input.err = DMA_INPUT_ERROR_NONE; 716 fimc_is_set_param_bit(is, PARAM_ISP_DMA1_INPUT); 717 718 isp->dma2_input.cmd = DMA_INPUT_COMMAND_DISABLE; 719 isp->dma2_input.width = 0; 720 isp->dma2_input.height = 0; 721 isp->dma2_input.format = 0; 722 isp->dma2_input.bitwidth = 0; 723 isp->dma2_input.plane = 0; 724 isp->dma2_input.order = 0; 725 isp->dma2_input.buffer_number = 0; 726 isp->dma2_input.width = 0; 727 isp->dma2_input.err = DMA_INPUT_ERROR_NONE; 728 fimc_is_set_param_bit(is, PARAM_ISP_DMA2_INPUT); 729 730 isp->aa.cmd = ISP_AA_COMMAND_START; 731 isp->aa.target = ISP_AA_TARGET_AE | ISP_AA_TARGET_AWB; 732 fimc_is_set_param_bit(is, PARAM_ISP_AA); 733 734 if (!test_bit(PARAM_ISP_FLASH, p_index)) 735 __is_set_isp_flash(is, ISP_FLASH_COMMAND_DISABLE, 736 ISP_FLASH_REDEYE_DISABLE); 737 738 if (!test_bit(PARAM_ISP_AWB, p_index)) 739 __is_set_isp_awb(is, ISP_AWB_COMMAND_AUTO, 0); 740 741 if (!test_bit(PARAM_ISP_IMAGE_EFFECT, p_index)) 742 __is_set_isp_effect(is, ISP_IMAGE_EFFECT_DISABLE); 743 744 if (!test_bit(PARAM_ISP_ISO, p_index)) 745 __is_set_isp_iso(is, ISP_ISO_COMMAND_AUTO, 0); 746 747 if (!test_bit(PARAM_ISP_ADJUST, p_index)) { 748 __is_set_isp_adjust(is, ISP_ADJUST_COMMAND_MANUAL_CONTRAST, 0); 749 __is_set_isp_adjust(is, 750 ISP_ADJUST_COMMAND_MANUAL_SATURATION, 0); 751 __is_set_isp_adjust(is, ISP_ADJUST_COMMAND_MANUAL_SHARPNESS, 0); 752 __is_set_isp_adjust(is, ISP_ADJUST_COMMAND_MANUAL_EXPOSURE, 0); 753 __is_set_isp_adjust(is, 754 ISP_ADJUST_COMMAND_MANUAL_BRIGHTNESS, 0); 755 __is_set_isp_adjust(is, ISP_ADJUST_COMMAND_MANUAL_HUE, 0); 756 } 757 758 if (!test_bit(PARAM_ISP_METERING, p_index)) { 759 __is_set_isp_metering(is, 0, ISP_METERING_COMMAND_CENTER); 760 __is_set_isp_metering(is, 1, 0); 761 __is_set_isp_metering(is, 2, 0); 762 __is_set_isp_metering(is, 3, 0); 763 __is_set_isp_metering(is, 4, 0); 764 } 765 766 if (!test_bit(PARAM_ISP_AFC, p_index)) 767 __is_set_isp_afc(is, ISP_AFC_COMMAND_AUTO, 0); 768 769 isp->otf_output.cmd = OTF_OUTPUT_COMMAND_ENABLE; 770 if (!test_bit(PARAM_ISP_OTF_OUTPUT, p_index)) { 771 isp->otf_output.width = DEFAULT_PREVIEW_STILL_WIDTH; 772 isp->otf_output.height = DEFAULT_PREVIEW_STILL_HEIGHT; 773 fimc_is_set_param_bit(is, PARAM_ISP_OTF_OUTPUT); 774 } 775 isp->otf_output.format = OTF_OUTPUT_FORMAT_YUV444; 776 isp->otf_output.bitwidth = 12; 777 isp->otf_output.order = 0; 778 isp->otf_output.err = OTF_OUTPUT_ERROR_NONE; 779 780 if (!test_bit(PARAM_ISP_DMA1_OUTPUT, p_index)) { 781 isp->dma1_output.cmd = DMA_OUTPUT_COMMAND_DISABLE; 782 isp->dma1_output.width = 0; 783 isp->dma1_output.height = 0; 784 isp->dma1_output.format = 0; 785 isp->dma1_output.bitwidth = 0; 786 isp->dma1_output.plane = 0; 787 isp->dma1_output.order = 0; 788 isp->dma1_output.buffer_number = 0; 789 isp->dma1_output.buffer_address = 0; 790 isp->dma1_output.notify_dma_done = 0; 791 isp->dma1_output.dma_out_mask = 0; 792 isp->dma1_output.err = DMA_OUTPUT_ERROR_NONE; 793 fimc_is_set_param_bit(is, PARAM_ISP_DMA1_OUTPUT); 794 } 795 796 if (!test_bit(PARAM_ISP_DMA2_OUTPUT, p_index)) { 797 isp->dma2_output.cmd = DMA_OUTPUT_COMMAND_DISABLE; 798 isp->dma2_output.width = 0; 799 isp->dma2_output.height = 0; 800 isp->dma2_output.format = 0; 801 isp->dma2_output.bitwidth = 0; 802 isp->dma2_output.plane = 0; 803 isp->dma2_output.order = 0; 804 isp->dma2_output.buffer_number = 0; 805 isp->dma2_output.buffer_address = 0; 806 isp->dma2_output.notify_dma_done = 0; 807 isp->dma2_output.dma_out_mask = 0; 808 isp->dma2_output.err = DMA_OUTPUT_ERROR_NONE; 809 fimc_is_set_param_bit(is, PARAM_ISP_DMA2_OUTPUT); 810 } 811 812 /* Sensor */ 813 if (!test_bit(PARAM_SENSOR_FRAME_RATE, p_index)) { 814 if (is->config_index == 0) 815 __is_set_sensor(is, 0); 816 } 817 818 /* DRC */ 819 drc->control.cmd = CONTROL_COMMAND_START; 820 __is_set_drc_control(is, CONTROL_BYPASS_ENABLE); 821 822 drc->otf_input.cmd = OTF_INPUT_COMMAND_ENABLE; 823 if (!test_bit(PARAM_DRC_OTF_INPUT, p_index)) { 824 drc->otf_input.width = DEFAULT_PREVIEW_STILL_WIDTH; 825 drc->otf_input.height = DEFAULT_PREVIEW_STILL_HEIGHT; 826 fimc_is_set_param_bit(is, PARAM_DRC_OTF_INPUT); 827 } 828 drc->otf_input.format = OTF_INPUT_FORMAT_YUV444; 829 drc->otf_input.bitwidth = 12; 830 drc->otf_input.order = 0; 831 drc->otf_input.err = OTF_INPUT_ERROR_NONE; 832 833 drc->dma_input.cmd = DMA_INPUT_COMMAND_DISABLE; 834 drc->dma_input.width = 0; 835 drc->dma_input.height = 0; 836 drc->dma_input.format = 0; 837 drc->dma_input.bitwidth = 0; 838 drc->dma_input.plane = 0; 839 drc->dma_input.order = 0; 840 drc->dma_input.buffer_number = 0; 841 drc->dma_input.width = 0; 842 drc->dma_input.err = DMA_INPUT_ERROR_NONE; 843 fimc_is_set_param_bit(is, PARAM_DRC_DMA_INPUT); 844 845 drc->otf_output.cmd = OTF_OUTPUT_COMMAND_ENABLE; 846 if (!test_bit(PARAM_DRC_OTF_OUTPUT, p_index)) { 847 drc->otf_output.width = DEFAULT_PREVIEW_STILL_WIDTH; 848 drc->otf_output.height = DEFAULT_PREVIEW_STILL_HEIGHT; 849 fimc_is_set_param_bit(is, PARAM_DRC_OTF_OUTPUT); 850 } 851 drc->otf_output.format = OTF_OUTPUT_FORMAT_YUV444; 852 drc->otf_output.bitwidth = 8; 853 drc->otf_output.order = 0; 854 drc->otf_output.err = OTF_OUTPUT_ERROR_NONE; 855 856 /* FD */ 857 __is_set_fd_control(is, CONTROL_COMMAND_STOP); 858 fd->control.bypass = CONTROL_BYPASS_DISABLE; 859 860 fd->otf_input.cmd = OTF_INPUT_COMMAND_ENABLE; 861 if (!test_bit(PARAM_FD_OTF_INPUT, p_index)) { 862 fd->otf_input.width = DEFAULT_PREVIEW_STILL_WIDTH; 863 fd->otf_input.height = DEFAULT_PREVIEW_STILL_HEIGHT; 864 fimc_is_set_param_bit(is, PARAM_FD_OTF_INPUT); 865 } 866 867 fd->otf_input.format = OTF_INPUT_FORMAT_YUV444; 868 fd->otf_input.bitwidth = 8; 869 fd->otf_input.order = 0; 870 fd->otf_input.err = OTF_INPUT_ERROR_NONE; 871 872 fd->dma_input.cmd = DMA_INPUT_COMMAND_DISABLE; 873 fd->dma_input.width = 0; 874 fd->dma_input.height = 0; 875 fd->dma_input.format = 0; 876 fd->dma_input.bitwidth = 0; 877 fd->dma_input.plane = 0; 878 fd->dma_input.order = 0; 879 fd->dma_input.buffer_number = 0; 880 fd->dma_input.width = 0; 881 fd->dma_input.err = DMA_INPUT_ERROR_NONE; 882 fimc_is_set_param_bit(is, PARAM_FD_DMA_INPUT); 883 884 __is_set_fd_config_maxface(is, 5); 885 __is_set_fd_config_rollangle(is, FD_CONFIG_ROLL_ANGLE_FULL); 886 __is_set_fd_config_yawangle(is, FD_CONFIG_YAW_ANGLE_45_90); 887 __is_set_fd_config_smilemode(is, FD_CONFIG_SMILE_MODE_DISABLE); 888 __is_set_fd_config_blinkmode(is, FD_CONFIG_BLINK_MODE_DISABLE); 889 __is_set_fd_config_eyedetect(is, FD_CONFIG_EYES_DETECT_ENABLE); 890 __is_set_fd_config_mouthdetect(is, FD_CONFIG_MOUTH_DETECT_DISABLE); 891 __is_set_fd_config_orientation(is, FD_CONFIG_ORIENTATION_DISABLE); 892 __is_set_fd_config_orientation_val(is, 0); 893 } 894