Lines Matching +full:enforce +full:- +full:video +full:- +full:mode
1 // SPDX-License-Identifier: GPL-2.0-only
5 * Copyright (C) 2010-2011 Lund Engineering
18 #include <linux/v4l2-mediabus.h>
20 #include <media/media-entity.h>
22 #include <media/v4l2-ctrls.h>
23 #include <media/v4l2-device.h>
24 #include <media/v4l2-subdev.h>
26 #include "aptina-pll.h"
31 * column 0- 15 active boundary
32 * column 16-1455 image
33 * column 1456-1471 active boundary
34 * column 1472-1599 black
36 * row 0- 51 black
37 * row 53- 59 active boundary
38 * row 60-1139 image
39 * row 1140-1147 active boundary
40 * row 1148-1151 black
156 (&((struct i2c_client *)v4l2_get_subdevdata(&(sensor)->subdev))->dev)
174 ns = div_u64(1000000000ULL * effective_width, sensor->pix_clock); in mt9m032_row_time()
182 struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev); in mt9m032_update_timing()
183 struct v4l2_rect *crop = &sensor->crop; in mt9m032_update_timing()
189 interval = &sensor->frame_interval; in mt9m032_update_timing()
191 row_time = mt9m032_row_time(sensor, crop->width); in mt9m032_update_timing()
193 vblank = div_u64(1000000000ULL * interval->numerator, in mt9m032_update_timing()
194 (u64)row_time * interval->denominator) in mt9m032_update_timing()
195 - crop->height; in mt9m032_update_timing()
199 interval->denominator = 1000; in mt9m032_update_timing()
200 interval->numerator = in mt9m032_update_timing()
201 div_u64((crop->height + MT9M032_VBLANK_MAX) * in mt9m032_update_timing()
202 (u64)row_time * interval->denominator, in mt9m032_update_timing()
204 vblank = div_u64(1000000000ULL * interval->numerator, in mt9m032_update_timing()
205 (u64)row_time * interval->denominator) in mt9m032_update_timing()
206 - crop->height; in mt9m032_update_timing()
208 /* enforce minimal 1.6ms blanking time. */ in mt9m032_update_timing()
217 struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev); in mt9m032_update_geom_timing()
221 sensor->crop.width - 1); in mt9m032_update_geom_timing()
224 sensor->crop.height - 1); in mt9m032_update_geom_timing()
227 sensor->crop.left); in mt9m032_update_geom_timing()
230 sensor->crop.top); in mt9m032_update_geom_timing()
238 struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev); in update_formatter2()
241 /* possibly for changing to 14-bit mode */ in update_formatter2()
267 struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev); in mt9m032_setup_pll()
268 struct mt9m032_platform_data *pdata = sensor->pdata; in mt9m032_setup_pll()
273 pll.ext_clock = pdata->ext_clock; in mt9m032_setup_pll()
274 pll.pix_clock = pdata->pix_clock; in mt9m032_setup_pll()
276 ret = aptina_pll_calculate(&client->dev, &limits, &pll); in mt9m032_setup_pll()
280 sensor->pix_clock = pdata->pix_clock; in mt9m032_setup_pll()
284 ((pll.n - 1) & MT9M032_PLL_CONFIG1_PREDIV_MASK)); in mt9m032_setup_pll()
289 if (!ret) /* more reserved, Continuous, Master Mode */ in mt9m032_setup_pll()
295 | MT9M032_FORMATTER1_PARALLEL | 0x001e; /* 14-bit */ in mt9m032_setup_pll()
302 /* -----------------------------------------------------------------------------
310 if (code->index != 0) in mt9m032_enum_mbus_code()
311 return -EINVAL; in mt9m032_enum_mbus_code()
313 code->code = MEDIA_BUS_FMT_Y8_1X8; in mt9m032_enum_mbus_code()
321 if (fse->index != 0 || fse->code != MEDIA_BUS_FMT_Y8_1X8) in mt9m032_enum_frame_size()
322 return -EINVAL; in mt9m032_enum_frame_size()
324 fse->min_width = MT9M032_COLUMN_SIZE_DEF; in mt9m032_enum_frame_size()
325 fse->max_width = MT9M032_COLUMN_SIZE_DEF; in mt9m032_enum_frame_size()
326 fse->min_height = MT9M032_ROW_SIZE_DEF; in mt9m032_enum_frame_size()
327 fse->max_height = MT9M032_ROW_SIZE_DEF; in mt9m032_enum_frame_size()
333 * __mt9m032_get_pad_crop() - get crop rect
346 return v4l2_subdev_get_try_crop(&sensor->subdev, cfg, 0); in __mt9m032_get_pad_crop()
348 return &sensor->crop; in __mt9m032_get_pad_crop()
355 * __mt9m032_get_pad_format() - get format
368 return v4l2_subdev_get_try_format(&sensor->subdev, cfg, 0); in __mt9m032_get_pad_format()
370 return &sensor->format; in __mt9m032_get_pad_format()
382 mutex_lock(&sensor->lock); in mt9m032_get_pad_format()
383 fmt->format = *__mt9m032_get_pad_format(sensor, cfg, fmt->which); in mt9m032_get_pad_format()
384 mutex_unlock(&sensor->lock); in mt9m032_get_pad_format()
396 mutex_lock(&sensor->lock); in mt9m032_set_pad_format()
398 if (sensor->streaming && fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) { in mt9m032_set_pad_format()
399 ret = -EBUSY; in mt9m032_set_pad_format()
404 fmt->format = *__mt9m032_get_pad_format(sensor, cfg, fmt->which); in mt9m032_set_pad_format()
408 mutex_unlock(&sensor->lock); in mt9m032_set_pad_format()
418 if (sel->target != V4L2_SEL_TGT_CROP) in mt9m032_get_pad_selection()
419 return -EINVAL; in mt9m032_get_pad_selection()
421 mutex_lock(&sensor->lock); in mt9m032_get_pad_selection()
422 sel->r = *__mt9m032_get_pad_crop(sensor, cfg, sel->which); in mt9m032_get_pad_selection()
423 mutex_unlock(&sensor->lock); in mt9m032_get_pad_selection()
438 if (sel->target != V4L2_SEL_TGT_CROP) in mt9m032_set_pad_selection()
439 return -EINVAL; in mt9m032_set_pad_selection()
441 mutex_lock(&sensor->lock); in mt9m032_set_pad_selection()
443 if (sensor->streaming && sel->which == V4L2_SUBDEV_FORMAT_ACTIVE) { in mt9m032_set_pad_selection()
444 ret = -EBUSY; in mt9m032_set_pad_selection()
451 rect.left = clamp(ALIGN(sel->r.left, 2), MT9M032_COLUMN_START_MIN, in mt9m032_set_pad_selection()
453 rect.top = clamp(ALIGN(sel->r.top, 2), MT9M032_ROW_START_MIN, in mt9m032_set_pad_selection()
455 rect.width = clamp_t(unsigned int, ALIGN(sel->r.width, 2), in mt9m032_set_pad_selection()
457 rect.height = clamp_t(unsigned int, ALIGN(sel->r.height, 2), in mt9m032_set_pad_selection()
461 MT9M032_PIXEL_ARRAY_WIDTH - rect.left); in mt9m032_set_pad_selection()
463 MT9M032_PIXEL_ARRAY_HEIGHT - rect.top); in mt9m032_set_pad_selection()
465 __crop = __mt9m032_get_pad_crop(sensor, cfg, sel->which); in mt9m032_set_pad_selection()
467 if (rect.width != __crop->width || rect.height != __crop->height) { in mt9m032_set_pad_selection()
471 format = __mt9m032_get_pad_format(sensor, cfg, sel->which); in mt9m032_set_pad_selection()
472 format->width = rect.width; in mt9m032_set_pad_selection()
473 format->height = rect.height; in mt9m032_set_pad_selection()
477 sel->r = rect; in mt9m032_set_pad_selection()
479 if (sel->which == V4L2_SUBDEV_FORMAT_ACTIVE) in mt9m032_set_pad_selection()
483 mutex_unlock(&sensor->lock); in mt9m032_set_pad_selection()
492 mutex_lock(&sensor->lock); in mt9m032_get_frame_interval()
494 fi->interval = sensor->frame_interval; in mt9m032_get_frame_interval()
495 mutex_unlock(&sensor->lock); in mt9m032_get_frame_interval()
506 mutex_lock(&sensor->lock); in mt9m032_set_frame_interval()
508 if (sensor->streaming) { in mt9m032_set_frame_interval()
509 ret = -EBUSY; in mt9m032_set_frame_interval()
514 if (fi->interval.denominator == 0) in mt9m032_set_frame_interval()
515 fi->interval.denominator = 1; in mt9m032_set_frame_interval()
517 ret = mt9m032_update_timing(sensor, &fi->interval); in mt9m032_set_frame_interval()
519 sensor->frame_interval = fi->interval; in mt9m032_set_frame_interval()
522 mutex_unlock(&sensor->lock); in mt9m032_set_frame_interval()
531 mutex_lock(&sensor->lock); in mt9m032_s_stream()
534 sensor->streaming = streaming; in mt9m032_s_stream()
535 mutex_unlock(&sensor->lock); in mt9m032_s_stream()
540 /* -----------------------------------------------------------------------------
549 struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev); in mt9m032_g_register()
552 if (reg->reg > 0xff) in mt9m032_g_register()
553 return -EINVAL; in mt9m032_g_register()
555 val = mt9m032_read(client, reg->reg); in mt9m032_g_register()
557 return -EIO; in mt9m032_g_register()
559 reg->size = 2; in mt9m032_g_register()
560 reg->val = val; in mt9m032_g_register()
569 struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev); in mt9m032_s_register()
571 if (reg->reg > 0xff) in mt9m032_s_register()
572 return -EINVAL; in mt9m032_s_register()
574 return mt9m032_write(client, reg->reg, reg->val); in mt9m032_s_register()
578 /* -----------------------------------------------------------------------------
584 struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev); in update_read_mode2()
595 struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev); in mt9m032_set_gain()
624 if (ctrl->id == V4L2_CID_GAIN && ctrl->val >= 63) { in mt9m032_try_ctrl()
626 ctrl->val &= ~1; in mt9m032_try_ctrl()
635 container_of(ctrl->handler, struct mt9m032, ctrls); in mt9m032_set_ctrl()
636 struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev); in mt9m032_set_ctrl()
639 switch (ctrl->id) { in mt9m032_set_ctrl()
641 return mt9m032_set_gain(sensor, ctrl->val); in mt9m032_set_ctrl()
644 /* case V4L2_CID_VFLIP: -- In the same cluster */ in mt9m032_set_ctrl()
645 return update_read_mode2(sensor, sensor->vflip->val, in mt9m032_set_ctrl()
646 sensor->hflip->val); in mt9m032_set_ctrl()
650 (ctrl->val >> 16) & 0xffff); in mt9m032_set_ctrl()
655 ctrl->val & 0xffff); in mt9m032_set_ctrl()
666 /* -------------------------------------------------------------------------- */
692 .video = &mt9m032_video_ops,
696 /* -----------------------------------------------------------------------------
703 struct mt9m032_platform_data *pdata = client->dev.platform_data; in mt9m032_probe()
704 struct i2c_adapter *adapter = client->adapter; in mt9m032_probe()
710 dev_err(&client->dev, "No platform data\n"); in mt9m032_probe()
711 return -EINVAL; in mt9m032_probe()
715 dev_warn(&client->dev, in mt9m032_probe()
716 "I2C-Adapter doesn't support I2C_FUNC_SMBUS_WORD\n"); in mt9m032_probe()
717 return -EIO; in mt9m032_probe()
720 if (!client->dev.platform_data) in mt9m032_probe()
721 return -ENODEV; in mt9m032_probe()
723 sensor = devm_kzalloc(&client->dev, sizeof(*sensor), GFP_KERNEL); in mt9m032_probe()
725 return -ENOMEM; in mt9m032_probe()
727 mutex_init(&sensor->lock); in mt9m032_probe()
729 sensor->pdata = pdata; in mt9m032_probe()
731 v4l2_i2c_subdev_init(&sensor->subdev, client, &mt9m032_ops); in mt9m032_probe()
732 sensor->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; in mt9m032_probe()
736 dev_err(&client->dev, "MT9M032 not detected, wrong version " in mt9m032_probe()
738 ret = -ENODEV; in mt9m032_probe()
742 dev_info(&client->dev, "MT9M032 detected at address 0x%02x\n", in mt9m032_probe()
743 client->addr); in mt9m032_probe()
745 sensor->frame_interval.numerator = 1; in mt9m032_probe()
746 sensor->frame_interval.denominator = 30; in mt9m032_probe()
748 sensor->crop.left = MT9M032_COLUMN_START_DEF; in mt9m032_probe()
749 sensor->crop.top = MT9M032_ROW_START_DEF; in mt9m032_probe()
750 sensor->crop.width = MT9M032_COLUMN_SIZE_DEF; in mt9m032_probe()
751 sensor->crop.height = MT9M032_ROW_SIZE_DEF; in mt9m032_probe()
753 sensor->format.width = sensor->crop.width; in mt9m032_probe()
754 sensor->format.height = sensor->crop.height; in mt9m032_probe()
755 sensor->format.code = MEDIA_BUS_FMT_Y8_1X8; in mt9m032_probe()
756 sensor->format.field = V4L2_FIELD_NONE; in mt9m032_probe()
757 sensor->format.colorspace = V4L2_COLORSPACE_SRGB; in mt9m032_probe()
759 v4l2_ctrl_handler_init(&sensor->ctrls, 5); in mt9m032_probe()
761 v4l2_ctrl_new_std(&sensor->ctrls, &mt9m032_ctrl_ops, in mt9m032_probe()
764 sensor->hflip = v4l2_ctrl_new_std(&sensor->ctrls, in mt9m032_probe()
767 sensor->vflip = v4l2_ctrl_new_std(&sensor->ctrls, in mt9m032_probe()
771 v4l2_ctrl_new_std(&sensor->ctrls, &mt9m032_ctrl_ops, in mt9m032_probe()
775 v4l2_ctrl_new_std(&sensor->ctrls, &mt9m032_ctrl_ops, in mt9m032_probe()
776 V4L2_CID_PIXEL_RATE, pdata->pix_clock, in mt9m032_probe()
777 pdata->pix_clock, 1, pdata->pix_clock); in mt9m032_probe()
779 if (sensor->ctrls.error) { in mt9m032_probe()
780 ret = sensor->ctrls.error; in mt9m032_probe()
781 dev_err(&client->dev, "control initialization error %d\n", ret); in mt9m032_probe()
785 v4l2_ctrl_cluster(2, &sensor->hflip); in mt9m032_probe()
787 sensor->subdev.ctrl_handler = &sensor->ctrls; in mt9m032_probe()
788 sensor->subdev.entity.function = MEDIA_ENT_F_CAM_SENSOR; in mt9m032_probe()
789 sensor->pad.flags = MEDIA_PAD_FL_SOURCE; in mt9m032_probe()
790 ret = media_entity_pads_init(&sensor->subdev.entity, 1, &sensor->pad); in mt9m032_probe()
806 ret = v4l2_ctrl_handler_setup(&sensor->ctrls); in mt9m032_probe()
827 if (sensor->pdata->invert_pixclock) { in mt9m032_probe()
849 media_entity_cleanup(&sensor->subdev.entity); in mt9m032_probe()
851 v4l2_ctrl_handler_free(&sensor->ctrls); in mt9m032_probe()
853 mutex_destroy(&sensor->lock); in mt9m032_probe()
863 v4l2_ctrl_handler_free(&sensor->ctrls); in mt9m032_remove()
864 media_entity_cleanup(&subdev->entity); in mt9m032_remove()
865 mutex_destroy(&sensor->lock); in mt9m032_remove()