From patchwork Mon Jul 3 09:16:06 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Hugues FRUCHET X-Patchwork-Id: 9822331 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 44E7460246 for ; Mon, 3 Jul 2017 09:18:36 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 6D02C251F4 for ; Mon, 3 Jul 2017 09:18:32 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 6181B28505; Mon, 3 Jul 2017 09:18:32 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-1.9 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID autolearn=unavailable version=3.3.1 Received: from bombadil.infradead.org (bombadil.infradead.org [65.50.211.133]) (using TLSv1.2 with cipher AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id 8C582251F4 for ; Mon, 3 Jul 2017 09:18:31 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20170209; h=Sender: Content-Transfer-Encoding:Content-Type:Cc:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-ID:Date:Subject:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=OU0tATvEZOsx9Wly/12kzgbJRQfKmkGrQfptz+rS9tU=; b=S53MdEuPO14JcC Z4O/VFeJz/cHFOsNk5fE32xX18B4Gbf2nJqGpm7psoLCO0UFPAYJC5WOtQi/HUBaUl68a9BFbLtYB Qy5QG/WiZjSHMVdSWASgTeeZd0TcrrbyuWB6YuO4TR755025Ltro9Sqi+PFgyjASQjTJG638NjQ81 f3Y+hOpFSUzdzL6rMDArgokB2O4zLdjRfkPO3hw1gZ+5OwIYg20vh3MizBFiFve93D8a4raa2IqMx PH1GDDQShMPsUYyb6b56jENhjflCGBG/w/1n4V8IaU5DMo5I+yfOkdERYK2VM85RWbZYAHV6BcVOt 0F1DOgT2Tr2Hb8ikK3sQ==; Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.87 #1 (Red Hat Linux)) id 1dRxUz-0000NB-It; Mon, 03 Jul 2017 09:18:29 +0000 Received: from mx08-00178001.pphosted.com ([91.207.212.93] helo=mx07-00178001.pphosted.com) by bombadil.infradead.org with esmtps (Exim 4.87 #1 (Red Hat Linux)) id 1dRxTX-0006X5-6W for linux-arm-kernel@lists.infradead.org; Mon, 03 Jul 2017 09:17:06 +0000 Received: from pps.filterd (m0046660.ppops.net [127.0.0.1]) by mx08-.pphosted.com (8.16.0.21/8.16.0.21) with SMTP id v639GWcE009882; Mon, 3 Jul 2017 11:16:33 +0200 Received: from beta.dmz-eu.st.com (beta.dmz-eu.st.com [164.129.1.35]) by mx08-.pphosted.com with ESMTP id 2be0v3b50y-1 (version=TLSv1 cipher=ECDHE-RSA-AES256-SHA bits=256 verify=NOT); Mon, 03 Jul 2017 11:16:32 +0200 Received: from zeta.dmz-eu.st.com (zeta.dmz-eu.st.com [164.129.230.9]) by beta.dmz-eu.st.com (STMicroelectronics) with ESMTP id 83C5A4D; Mon, 3 Jul 2017 09:16:27 +0000 (GMT) Received: from Webmail-eu.st.com (Safex1hubcas23.st.com [10.75.90.46]) by zeta.dmz-eu.st.com (STMicroelectronics) with ESMTP id 5752D1487; Mon, 3 Jul 2017 09:16:27 +0000 (GMT) Received: from localhost (10.201.23.73) by webmail-ga.st.com (10.75.90.48) with Microsoft SMTP Server (TLS) id 14.3.339.0; Mon, 3 Jul 2017 11:16:26 +0200 From: Hugues Fruchet To: Sylwester Nawrocki , " H. Nikolaus Schaller" , Guennadi Liakhovetski , Rob Herring , Mark Rutland , Maxime Coquelin , Alexandre Torgue , Mauro Carvalho Chehab , Hans Verkuil Subject: [PATCH v2 5/7] [media] ov9650: add multiple variant support Date: Mon, 3 Jul 2017 11:16:06 +0200 Message-ID: <1499073368-31905-6-git-send-email-hugues.fruchet@st.com> X-Mailer: git-send-email 1.9.1 In-Reply-To: <1499073368-31905-1-git-send-email-hugues.fruchet@st.com> References: <1499073368-31905-1-git-send-email-hugues.fruchet@st.com> MIME-Version: 1.0 X-Originating-IP: [10.201.23.73] X-Proofpoint-Virus-Version: vendor=fsecure engine=2.50.10432:, , definitions=2017-07-03_06:, , signatures=0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20170703_021659_600894_E94C36C1 X-CRM114-Status: GOOD ( 17.92 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.21 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, Yannick Fertre , Benjamin Gaignard , Hugues Fruchet , linux-arm-kernel@lists.infradead.org, linux-media@vger.kernel.org Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org X-Virus-Scanned: ClamAV using ClamSMTP Ops support and registers set can now be different from a variant to another. Signed-off-by: Hugues Fruchet --- drivers/media/i2c/ov9650.c | 156 ++++++++++++++++++++++++++++----------------- 1 file changed, 99 insertions(+), 57 deletions(-) diff --git a/drivers/media/i2c/ov9650.c b/drivers/media/i2c/ov9650.c index db96698..50397e6 100644 --- a/drivers/media/i2c/ov9650.c +++ b/drivers/media/i2c/ov9650.c @@ -38,7 +38,7 @@ module_param(debug, int, 0644); MODULE_PARM_DESC(debug, "Debug level (0-2)"); -#define DRIVER_NAME "OV9650" +#define DRIVER_NAME "ov965x" /* * OV9650/OV9652 register definitions @@ -239,6 +239,13 @@ struct ov965x_framesize { const struct i2c_rv *regs; }; +struct ov965x_pixfmt { + u32 code; + u32 colorspace; + /* REG_TSLB value, only bits [3:2] may be set. */ + u8 tslb_reg; +}; + struct ov965x_interval { struct v4l2_fract interval; /* Maximum resolution for this interval */ @@ -257,6 +264,21 @@ struct ov965x { struct media_pad pad; enum v4l2_mbus_type bus_type; struct gpio_desc *gpios[NUM_GPIOS]; + + /* Variant specific regs and ops */ + const struct i2c_rv *init_regs; + const struct ov965x_framesize *framesizes; + unsigned int nb_of_framesizes; + const struct ov965x_pixfmt *formats; + unsigned int nb_of_formats; + const struct ov965x_interval *intervals; + unsigned int nb_of_intervals; + int (*initialize_controls)(struct ov965x *ov965x); + int (*set_frame_interval)(struct ov965x *ov965x, + struct v4l2_subdev_frame_interval *fi); + void (*update_exposure_ctrl)(struct ov965x *ov965x); + int (*set_params)(struct ov965x *ov965x); + /* External master clock frequency */ unsigned long mclk_frequency; struct clk *clk; @@ -416,13 +438,6 @@ struct ov965x { }, }; -struct ov965x_pixfmt { - u32 code; - u32 colorspace; - /* REG_TSLB value, only bits [3:2] may be set. */ - u8 tslb_reg; -}; - static const struct ov965x_pixfmt ov965x_formats[] = { { MEDIA_BUS_FMT_YUYV8_2X8, V4L2_COLORSPACE_JPEG, 0x00}, { MEDIA_BUS_FMT_YVYU8_2X8, V4L2_COLORSPACE_JPEG, 0x04}, @@ -576,7 +591,7 @@ static int ov965x_s_power(struct v4l2_subdev *sd, int on) __ov965x_set_power(ov965x, on); if (on) { ret = ov965x_write_array(client, - ov965x_init_regs); + ov965x->init_regs); ov965x->apply_frame_fmt = 1; ov965x->ctrls.update = 1; } @@ -1090,12 +1105,13 @@ static int ov965x_initialize_controls(struct ov965x *ov965x) /* * V4L2 subdev video and pad level operations */ -static void ov965x_get_default_format(struct v4l2_mbus_framefmt *mf) +static void ov965x_get_default_format(struct ov965x *ov965x, + struct v4l2_mbus_framefmt *mf) { - mf->width = ov965x_framesizes[0].width; - mf->height = ov965x_framesizes[0].height; - mf->colorspace = ov965x_formats[0].colorspace; - mf->code = ov965x_formats[0].code; + mf->width = ov965x->framesizes[0].width; + mf->height = ov965x->framesizes[0].height; + mf->colorspace = ov965x->formats[0].colorspace; + mf->code = ov965x->formats[0].code; mf->field = V4L2_FIELD_NONE; } @@ -1103,10 +1119,12 @@ static int ov965x_enum_mbus_code(struct v4l2_subdev *sd, struct v4l2_subdev_pad_config *cfg, struct v4l2_subdev_mbus_code_enum *code) { - if (code->index >= ARRAY_SIZE(ov965x_formats)) + struct ov965x *ov965x = to_ov965x(sd); + + if (code->index >= ov965x->nb_of_formats) return -EINVAL; - code->code = ov965x_formats[code->index].code; + code->code = ov965x->formats[code->index].code; return 0; } @@ -1114,22 +1132,22 @@ static int ov965x_enum_frame_sizes(struct v4l2_subdev *sd, struct v4l2_subdev_pad_config *cfg, struct v4l2_subdev_frame_size_enum *fse) { - int i = ARRAY_SIZE(ov965x_formats); + struct ov965x *ov965x = to_ov965x(sd); + int i = ov965x->nb_of_formats; - if (fse->index >= ARRAY_SIZE(ov965x_framesizes)) + if (fse->index >= ov965x->nb_of_framesizes) return -EINVAL; while (--i) - if (fse->code == ov965x_formats[i].code) + if (fse->code == ov965x->formats[i].code) break; - fse->code = ov965x_formats[i].code; + fse->code = ov965x->formats[i].code; - fse->min_width = ov965x_framesizes[fse->index].width; + fse->min_width = ov965x->framesizes[fse->index].width; fse->max_width = fse->min_width; - fse->max_height = ov965x_framesizes[fse->index].height; + fse->max_height = ov965x->framesizes[fse->index].height; fse->min_height = fse->max_height; - return 0; } @@ -1138,6 +1156,9 @@ static int ov965x_g_frame_interval(struct v4l2_subdev *sd, { struct ov965x *ov965x = to_ov965x(sd); + if (!ov965x->fiv) + return 0; + mutex_lock(&ov965x->lock); fi->interval = ov965x->fiv->interval; mutex_unlock(&ov965x->lock); @@ -1146,13 +1167,15 @@ static int ov965x_g_frame_interval(struct v4l2_subdev *sd, } static int __ov965x_set_frame_interval(struct ov965x *ov965x, - struct v4l2_subdev_frame_interval *fi) + struct v4l2_subdev_frame_interval *fi) { struct v4l2_mbus_framefmt *mbus_fmt = &ov965x->format; - const struct ov965x_interval *fiv = &ov965x_intervals[0]; + const struct ov965x_interval *fiv = ov965x->intervals; u64 req_int, err, min_err = ~0ULL; unsigned int i; + if (!fiv) + return 0; if (fi->interval.denominator == 0) return -EINVAL; @@ -1160,8 +1183,8 @@ static int __ov965x_set_frame_interval(struct ov965x *ov965x, req_int = (u64)(fi->interval.numerator * 10000) / fi->interval.denominator; - for (i = 0; i < ARRAY_SIZE(ov965x_intervals); i++) { - const struct ov965x_interval *iv = &ov965x_intervals[i]; + for (i = 0; i < ov965x->nb_of_intervals; i++) { + const struct ov965x_interval *iv = ov965x->intervals; if (mbus_fmt->width != iv->size.width || mbus_fmt->height != iv->size.height) @@ -1185,13 +1208,15 @@ static int ov965x_s_frame_interval(struct v4l2_subdev *sd, struct v4l2_subdev_frame_interval *fi) { struct ov965x *ov965x = to_ov965x(sd); - int ret; + int ret = 0; v4l2_dbg(1, debug, sd, "Setting %d/%d frame interval\n", fi->interval.numerator, fi->interval.denominator); mutex_lock(&ov965x->lock); - ret = __ov965x_set_frame_interval(ov965x, fi); + if (ov965x->set_frame_interval) + ret = ov965x->set_frame_interval(ov965x, fi); + ov965x->apply_frame_fmt = 1; mutex_unlock(&ov965x->lock); return ret; @@ -1216,12 +1241,13 @@ static int ov965x_get_fmt(struct v4l2_subdev *sd, struct v4l2_subdev_pad_config return 0; } -static void __ov965x_try_frame_size(struct v4l2_mbus_framefmt *mf, +static void __ov965x_try_frame_size(struct ov965x *ov965x, + struct v4l2_mbus_framefmt *mf, const struct ov965x_framesize **size) { - const struct ov965x_framesize *fsize = &ov965x_framesizes[0], + const struct ov965x_framesize *fsize = &ov965x->framesizes[0], *match = NULL; - int i = ARRAY_SIZE(ov965x_framesizes); + int i = ov965x->nb_of_framesizes; unsigned int min_err = UINT_MAX; while (i--) { @@ -1234,7 +1260,7 @@ static void __ov965x_try_frame_size(struct v4l2_mbus_framefmt *mf, fsize++; } if (!match) - match = &ov965x_framesizes[0]; + match = &ov965x->framesizes[0]; mf->width = match->width; mf->height = match->height; if (size) @@ -1244,20 +1270,20 @@ static void __ov965x_try_frame_size(struct v4l2_mbus_framefmt *mf, static int ov965x_set_fmt(struct v4l2_subdev *sd, struct v4l2_subdev_pad_config *cfg, struct v4l2_subdev_format *fmt) { - unsigned int index = ARRAY_SIZE(ov965x_formats); - struct v4l2_mbus_framefmt *mf = &fmt->format; struct ov965x *ov965x = to_ov965x(sd); + unsigned int index = ov965x->nb_of_formats; + struct v4l2_mbus_framefmt *mf = &fmt->format; const struct ov965x_framesize *size = NULL; int ret = 0; - __ov965x_try_frame_size(mf, &size); + __ov965x_try_frame_size(ov965x, mf, &size); while (--index) - if (ov965x_formats[index].code == mf->code) + if (ov965x->formats[index].code == mf->code) break; mf->colorspace = V4L2_COLORSPACE_JPEG; - mf->code = ov965x_formats[index].code; + mf->code = ov965x->formats[index].code; mf->field = V4L2_FIELD_NONE; mutex_lock(&ov965x->lock); @@ -1273,7 +1299,7 @@ static int ov965x_set_fmt(struct v4l2_subdev *sd, struct v4l2_subdev_pad_config } else { ov965x->frame_size = size; ov965x->format = fmt->format; - ov965x->tslb_reg = ov965x_formats[index].tslb_reg; + ov965x->tslb_reg = ov965x->formats[index].tslb_reg; ov965x->apply_frame_fmt = 1; } } @@ -1283,12 +1309,14 @@ static int ov965x_set_fmt(struct v4l2_subdev *sd, struct v4l2_subdev_pad_config .interval = { 0, 1 } }; /* Reset to minimum possible frame interval */ - __ov965x_set_frame_interval(ov965x, &fiv); + if (ov965x->set_frame_interval) + ret = ov965x->set_frame_interval(ov965x, &fiv); } mutex_unlock(&ov965x->lock); if (!ret) - ov965x_update_exposure_ctrl(ov965x); + if (ov965x->update_exposure_ctrl) + ov965x->update_exposure_ctrl(ov965x); return ret; } @@ -1363,7 +1391,8 @@ static int ov965x_s_stream(struct v4l2_subdev *sd, int on) mutex_lock(&ov965x->lock); if (ov965x->streaming == !on) { if (on) - ret = __ov965x_set_params(ov965x); + if (ov965x->set_params) + ret = ov965x->set_params(ov965x); if (!ret && ctrls->update) { /* @@ -1396,8 +1425,9 @@ static int ov965x_s_stream(struct v4l2_subdev *sd, int on) static int ov965x_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh) { struct v4l2_mbus_framefmt *mf = v4l2_subdev_get_try_format(sd, fh->pad, 0); + struct ov965x *ov965x = to_ov965x(sd); - ov965x_get_default_format(mf); + ov965x_get_default_format(ov965x, mf); return 0; } @@ -1516,8 +1546,6 @@ static int ov965x_probe(struct i2c_client *client, ov965x = devm_kzalloc(&client->dev, sizeof(*ov965x), GFP_KERNEL); if (!ov965x) return -ENOMEM; - - mutex_init(&ov965x->lock); ov965x->client = client; mutex_init(&ov965x->lock); @@ -1557,38 +1585,52 @@ static int ov965x_probe(struct i2c_client *client, sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_HAS_EVENTS; - ret = ov965x_configure_gpios(ov965x, pdata); - if (ret < 0) - return ret; - ov965x->pad.flags = MEDIA_PAD_FL_SOURCE; sd->entity.function = MEDIA_ENT_F_CAM_SENSOR; ret = media_entity_pads_init(&sd->entity, 1, &ov965x->pad); if (ret < 0) return ret; - ret = ov965x_initialize_controls(ov965x); + ret = ov965x_detect_sensor(sd); if (ret < 0) goto err_me; - ov965x_get_default_format(&ov965x->format); - ov965x->frame_size = &ov965x_framesizes[0]; + ov965x->init_regs = ov965x_init_regs; + ov965x->initialize_controls = ov965x_initialize_controls; + ov965x->framesizes = ov965x_framesizes; + ov965x->nb_of_framesizes = ARRAY_SIZE(ov965x_framesizes); + ov965x->formats = ov965x_formats; + ov965x->nb_of_formats = ARRAY_SIZE(ov965x_formats); + ov965x->intervals = ov965x_intervals; + ov965x->nb_of_intervals = ARRAY_SIZE(ov965x_intervals); ov965x->fiv = &ov965x_intervals[0]; + ov965x->set_frame_interval = __ov965x_set_frame_interval; + ov965x->update_exposure_ctrl = ov965x_update_exposure_ctrl; + ov965x->set_params = __ov965x_set_params; - ret = ov965x_detect_sensor(sd); - if (ret < 0) - goto err_ctrls; + ov965x->frame_size = &ov965x->framesizes[0]; + ov965x_get_default_format(ov965x, &ov965x->format); + + if (ov965x->initialize_controls) { + ret = ov965x->initialize_controls(ov965x); + if (ret < 0) + goto err_ctrls; + } /* Update exposure time min/max to match frame format */ - ov965x_update_exposure_ctrl(ov965x); + if (ov965x->update_exposure_ctrl) + ov965x->update_exposure_ctrl(ov965x); ret = v4l2_async_register_subdev(sd); if (ret < 0) goto err_ctrls; + dev_info(&client->dev, "%s driver probed\n", sd->name); return 0; + err_ctrls: - v4l2_ctrl_handler_free(sd->ctrl_handler); + if (sd->ctrl_handler) + v4l2_ctrl_handler_free(sd->ctrl_handler); err_me: media_entity_cleanup(&sd->entity); return ret;