From patchwork Sat Jun 17 12:59:19 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Pavel Machek X-Patchwork-Id: 9794071 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 EEC85600C5 for ; Sat, 17 Jun 2017 12:59:30 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id D322C284D2 for ; Sat, 17 Jun 2017 12:59:30 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id C49FD2855D; Sat, 17 Jun 2017 12:59:30 +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=-6.9 required=2.0 tests=BAYES_00,RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id E9D86284D2 for ; Sat, 17 Jun 2017 12:59:29 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1753019AbdFQM7X (ORCPT ); Sat, 17 Jun 2017 08:59:23 -0400 Received: from atrey.karlin.mff.cuni.cz ([195.113.26.193]:40225 "EHLO atrey.karlin.mff.cuni.cz" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1751969AbdFQM7V (ORCPT ); Sat, 17 Jun 2017 08:59:21 -0400 Received: by atrey.karlin.mff.cuni.cz (Postfix, from userid 512) id DE4378254D; Sat, 17 Jun 2017 14:59:19 +0200 (CEST) Date: Sat, 17 Jun 2017 14:59:19 +0200 From: Pavel Machek To: Sakari Ailus Cc: linux-media@vger.kernel.org, linux-leds@vger.kernel.org, devicetree@vger.kernel.org, sebastian.reichel@collabora.co.uk, robh@kernel.org Subject: Re: [PATCH 7/8] smiapp: Add support for flash, lens and EEPROM devices Message-ID: <20170617125919.GB13133@amd> References: <1497433639-13101-1-git-send-email-sakari.ailus@linux.intel.com> <1497433639-13101-8-git-send-email-sakari.ailus@linux.intel.com> <20170616124242.GA8145@amd> <20170616124526.GM15419@paasikivi.fi.intel.com> MIME-Version: 1.0 Content-Disposition: inline In-Reply-To: <20170616124526.GM15419@paasikivi.fi.intel.com> User-Agent: Mutt/1.5.23 (2014-03-12) Sender: linux-media-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-media@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Hi! > > This is quite a lot of boilerplate for that. Would it make sense to > > provide helper function at least for this? > > Yes. I've been thinking of having helper functions for notifiers and > sub-notifiers. Most of the receiver drivers are implementing exactly the > same thing but with different twists (read: bugs). Perhaps something like this is a starting point? Pavel commit 22d722b7ee7cb437ae2013fa83a215f91151621c Author: Pavel Date: Sat Jun 17 14:14:08 2017 +0200 Subdev support for et8ek8. Subdev code is ready for moving to some other place -- this is really common code. Signed-off-by: Pavel Machek diff --git a/drivers/media/i2c/et8ek8/et8ek8_driver.c b/drivers/media/i2c/et8ek8/et8ek8_driver.c index 05b9bd9..a6899fc 100644 --- a/drivers/media/i2c/et8ek8/et8ek8_driver.c +++ b/drivers/media/i2c/et8ek8/et8ek8_driver.c @@ -32,13 +32,90 @@ #include #include #include -#include +#include +#include #include #include #include #include +static int simple_subdev_notifier_bound(struct v4l2_async_notifier *notifier, + struct v4l2_subdev *sd, + struct v4l2_async_subdev *asd) +{ + return 0; +} + +static int simple_subdev_notifier_complete( + struct v4l2_async_notifier *notifier) +{ + struct v4l2_async_notifier_simple *notifier_s = + container_of(notifier, struct v4l2_async_notifier_simple, notifier); + + return v4l2_device_register_subdev_nodes(notifier_s->v4l2_dev); +} + +static inline int v4l2_simple_subnotifier_register(struct v4l2_subdev *subdev, + struct v4l2_async_notifier_simple *notifier_s) +{ + struct v4l2_async_notifier *notifier = ¬ifier_s->notifier; + int rval; + if (!notifier->num_subdevs) + return 0; + + notifier_s->v4l2_dev = subdev->v4l2_dev; + notifier->bound = simple_subdev_notifier_bound; + notifier->complete = simple_subdev_notifier_complete; + rval = v4l2_async_subnotifier_register(subdev, notifier); + return rval; +} + +static inline int simple_subdev_probe(struct device *dev, + struct v4l2_async_notifier *notifier) +{ + static const char *props[] = { "flash", "lens", "eeprom" }; + unsigned int i; + const int max_subdevs = 3; + + notifier->subdevs = + devm_kcalloc(dev, max_subdevs, + sizeof(struct v4l2_async_subdev *), GFP_KERNEL); + if (!notifier->subdevs) + return -ENOMEM; + + for (i = 0; i < ARRAY_SIZE(props); i++) { + struct device_node *node; + unsigned int j = 0; + + while ((node = of_parse_phandle(dev->of_node, props[i], j++))) { + struct v4l2_async_subdev **asd = + ¬ifier->subdevs[ + notifier->num_subdevs]; + + if (WARN_ON(notifier->num_subdevs >= max_subdevs)) { + of_node_put(node); + return 0; + } + + *asd = devm_kzalloc( + dev, sizeof(struct v4l2_async_subdev), + GFP_KERNEL); + if (!*asd) { + of_node_put(node); + return 0; + } + + (*asd)->match.fwnode.fwnode = of_fwnode_handle(node); + (*asd)->match_type = V4L2_ASYNC_MATCH_FWNODE; + notifier->num_subdevs++; + + of_node_put(node); + } + } + return 0; +} + #include "et8ek8_reg.h" #define ET8EK8_NAME "et8ek8" @@ -67,6 +144,8 @@ struct et8ek8_sensor { struct mutex power_lock; int power_count; + + struct v4l2_async_notifier_simple notifier_s; }; #define to_et8ek8_sensor(sd) container_of(sd, struct et8ek8_sensor, subdev) @@ -1510,6 +1589,8 @@ et8ek8_registered(struct v4l2_subdev *subdev) goto err_file; } + v4l2_simple_subnotifier_register(subdev, &sensor->notifier_s); + __et8ek8_get_pad_format(sensor, NULL, 0, V4L2_SUBDEV_FORMAT_ACTIVE); return 0; @@ -1680,6 +1761,8 @@ static int et8ek8_probe(struct i2c_client *client, if (ret < 0) goto err_entity; + simple_subdev_probe(dev, &sensor->notifier_s.notifier); + dev_dbg(dev, "initialized!\n"); return 0; diff --git a/include/media/v4l2-async.h b/include/media/v4l2-async.h index f7e2a1a..63bcf80 100644 --- a/include/media/v4l2-async.h +++ b/include/media/v4l2-async.h @@ -104,6 +104,11 @@ struct v4l2_async_notifier { struct v4l2_async_subdev *asd); }; +struct v4l2_async_notifier_simple { + struct v4l2_async_notifier notifier; + struct v4l2_device * v4l2_dev; +}; + /** * v4l2_async_notifier_register - registers a subdevice asynchronous subnotifier *