From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-18.8 required=3.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_CR_TRAILER, INCLUDES_PATCH,MAILING_LIST_MULTI,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED, USER_AGENT_GIT autolearn=unavailable autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 9981CC433E6 for ; Tue, 16 Feb 2021 14:48:24 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id 726CF64E02 for ; Tue, 16 Feb 2021 14:48:24 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230216AbhBPOsI (ORCPT ); Tue, 16 Feb 2021 09:48:08 -0500 Received: from mta-02.yadro.com ([89.207.88.252]:36556 "EHLO mta-01.yadro.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S230334AbhBPOrw (ORCPT ); Tue, 16 Feb 2021 09:47:52 -0500 Received: from localhost (unknown [127.0.0.1]) by mta-01.yadro.com (Postfix) with ESMTP id 4B3684127F; Tue, 16 Feb 2021 14:47:10 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=yadro.com; h= content-type:content-type:content-transfer-encoding:mime-version :references:in-reply-to:x-mailer:message-id:date:date:subject :subject:from:from:received:received:received; s=mta-01; t= 1613486829; x=1615301230; bh=CIMfNlWK4nLJTRw1srlHMvV5jdyPAR10M2V tXfB/wwI=; b=q3qV8QC7X/OzstSXjAq4zpRO/IWk1qN7wdrgkQzDE52JRXD7b5d UewyyG75fMiMF+4Y/wV8zh9HD7Kwrwux2WuUMUWhKJgwkc1/d8rLLxYYvYeJIiB4 EZuumEAwgn8fTcK3FFdYyu3TzofN9ucIgxXqjyPUXK4fait5t+xos9x4= X-Virus-Scanned: amavisd-new at yadro.com Received: from mta-01.yadro.com ([127.0.0.1]) by localhost (mta-01.yadro.com [127.0.0.1]) (amavisd-new, port 10024) with ESMTP id uSSCWQ5VgaZA; Tue, 16 Feb 2021 17:47:09 +0300 (MSK) Received: from T-EXCH-03.corp.yadro.com (t-exch-03.corp.yadro.com [172.17.100.103]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-SHA384 (256/256 bits)) (No client certificate requested) by mta-01.yadro.com (Postfix) with ESMTPS id 03AFB41203; Tue, 16 Feb 2021 17:47:09 +0300 (MSK) Received: from localhost.dev.yadro.com (10.199.0.29) by T-EXCH-03.corp.yadro.com (172.17.100.103) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_CBC_SHA384_P384) id 15.1.669.32; Tue, 16 Feb 2021 17:47:08 +0300 From: Ivan Mikhaylov To: Jonathan Cameron , Lars-Peter Clausen , Peter Meerwald-Stadler , Rob Herring CC: Ivan Mikhaylov , , , Subject: [PATCH 1/2] iio: proximity: vcnl3020: add proximity rate Date: Tue, 16 Feb 2021 17:53:45 +0300 Message-ID: <20210216145346.18304-2-i.mikhaylov@yadro.com> X-Mailer: git-send-email 2.26.2 In-Reply-To: <20210216145346.18304-1-i.mikhaylov@yadro.com> References: <20210216145346.18304-1-i.mikhaylov@yadro.com> MIME-Version: 1.0 Content-Transfer-Encoding: 8bit Content-Type: text/plain X-Originating-IP: [10.199.0.29] X-ClientProxiedBy: T-EXCH-01.corp.yadro.com (172.17.10.101) To T-EXCH-03.corp.yadro.com (172.17.100.103) Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Add the proximity rate optional option and handling of it for vishay vcnl3020. Signed-off-by: Ivan Mikhaylov --- drivers/iio/proximity/vcnl3020.c | 123 ++++++++++++++++++++++++++++++- 1 file changed, 120 insertions(+), 3 deletions(-) diff --git a/drivers/iio/proximity/vcnl3020.c b/drivers/iio/proximity/vcnl3020.c index 37264f801ad0..833c5d5ac0a1 100644 --- a/drivers/iio/proximity/vcnl3020.c +++ b/drivers/iio/proximity/vcnl3020.c @@ -40,6 +40,17 @@ #define VCNL_ON_DEMAND_TIMEOUT_US 100000 #define VCNL_POLL_US 20000 +static const int vcnl3020_prox_sampling_frequency[][2] = { + {1, 950000}, + {3, 906250}, + {7, 812500}, + {16, 625000}, + {31, 250000}, + {62, 500000}, + {125, 0}, + {250, 0}, +}; + /** * struct vcnl3020_data - vcnl3020 specific data. * @regmap: device register map. @@ -75,12 +86,37 @@ static u32 microamp_to_reg(u32 *val) return *val /= 10000; }; +static u32 hz_to_reg(u32 *val) +{ + unsigned int i; + int index = -1; + + for (i = 0; i < ARRAY_SIZE(vcnl3020_prox_sampling_frequency); i++) { + if (*val == vcnl3020_prox_sampling_frequency[i][0]) { + index = i; + break; + } + } + + *val = index; + if (index < 0) + *val = 0; + + return *val; +}; + static struct vcnl3020_property vcnl3020_led_current_property = { .name = "vishay,led-current-microamp", .reg = VCNL_LED_CURRENT, .conversion_func = microamp_to_reg, }; +static struct vcnl3020_property vcnl3020_proximity_rate_property = { + .name = "vishay,proximity-rate-hz", + .reg = VCNL_PROXIMITY_RATE, + .conversion_func = hz_to_reg, +}; + static int vcnl3020_get_and_apply_property(struct vcnl3020_data *data, struct vcnl3020_property prop) { @@ -125,8 +161,18 @@ static int vcnl3020_init(struct vcnl3020_data *data) data->rev = reg; mutex_init(&data->lock); - return vcnl3020_get_and_apply_property(data, - vcnl3020_led_current_property); + rc = vcnl3020_get_and_apply_property(data, + vcnl3020_led_current_property); + if (rc) { + goto err_prop_set; + } + + rc = vcnl3020_get_and_apply_property(data, + vcnl3020_proximity_rate_property); + +err_prop_set: + + return rc; }; static int vcnl3020_measure_proximity(struct vcnl3020_data *data, int *val) @@ -165,10 +211,50 @@ static int vcnl3020_measure_proximity(struct vcnl3020_data *data, int *val) return rc; } +static int vcnl3020_read_proxy_samp_freq(struct vcnl3020_data *data, int *val, + int *val2) +{ + int rc; + unsigned int prox_rate; + + rc = regmap_read(data->regmap, VCNL_PROXIMITY_RATE, &prox_rate); + if (rc) + return rc; + + if (prox_rate >= ARRAY_SIZE(vcnl3020_prox_sampling_frequency)) + return -EINVAL; + + *val = vcnl3020_prox_sampling_frequency[prox_rate][0]; + *val2 = vcnl3020_prox_sampling_frequency[prox_rate][1]; + + return 0; +} + +static int vcnl3020_write_proxy_samp_freq(struct vcnl3020_data *data, int val, + int val2) +{ + unsigned int i; + int index = -1; + + for (i = 0; i < ARRAY_SIZE(vcnl3020_prox_sampling_frequency); i++) { + if (val == vcnl3020_prox_sampling_frequency[i][0] && + val2 == vcnl3020_prox_sampling_frequency[i][1]) { + index = i; + break; + } + } + + if (index < 0) + return -EINVAL; + + return regmap_write(data->regmap, VCNL_PROXIMITY_RATE, index); +} + static const struct iio_chan_spec vcnl3020_channels[] = { { .type = IIO_PROXIMITY, - .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | + BIT(IIO_CHAN_INFO_SAMP_FREQ), }, }; @@ -185,13 +271,44 @@ static int vcnl3020_read_raw(struct iio_dev *indio_dev, if (rc) return rc; return IIO_VAL_INT; + case IIO_CHAN_INFO_SAMP_FREQ: + rc = vcnl3020_read_proxy_samp_freq(data, val, val2); + if (rc < 0) + return rc; + return IIO_VAL_INT_PLUS_MICRO; default: return -EINVAL; } } +static int vcnl3020_write_raw(struct iio_dev *indio_dev, + struct iio_chan_spec const *chan, + int val, int val2, long mask) +{ + int rc; + struct vcnl3020_data *data = iio_priv(indio_dev); + + rc = iio_device_claim_direct_mode(indio_dev); + if (rc) + return rc; + + switch (mask) { + case IIO_CHAN_INFO_SAMP_FREQ: + rc = vcnl3020_write_proxy_samp_freq(data, val, val2); + goto end; + default: + rc = -EINVAL; + goto end; + } + +end: + iio_device_release_direct_mode(indio_dev); + return rc; +} + static const struct iio_info vcnl3020_info = { .read_raw = vcnl3020_read_raw, + .write_raw = vcnl3020_write_raw, }; static const struct regmap_config vcnl3020_regmap_config = { -- 2.26.2