From nobody Fri Sep 20 20:25:46 2024 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id 6E37FC77B7E for ; Thu, 1 Jun 2023 11:08:59 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S233283AbjFALI4 (ORCPT ); Thu, 1 Jun 2023 07:08:56 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:57594 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S232959AbjFALIg (ORCPT ); Thu, 1 Jun 2023 07:08:36 -0400 Received: from madras.collabora.co.uk (madras.collabora.co.uk [IPv6:2a00:1098:0:82:1000:25:2eeb:e5ab]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 7FD92137; Thu, 1 Jun 2023 04:08:27 -0700 (PDT) Received: from IcarusMOD.eternityproject.eu (unknown [IPv6:2001:b07:2ed:14ed:a962:cd4d:a84:1eab]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits) key-exchange X25519 server-signature RSA-PSS (4096 bits) server-digest SHA256) (No client certificate requested) (Authenticated sender: kholk11) by madras.collabora.co.uk (Postfix) with ESMTPSA id 986D16601F25; Thu, 1 Jun 2023 12:08:25 +0100 (BST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=collabora.com; s=mail; t=1685617706; bh=DPBhltzyuRCNEl6YGHUeKrC3g1X5wZMtA70z/OT6qms=; h=From:To:Cc:Subject:Date:In-Reply-To:References:From; b=cnulaFYHEGSZCT8dmjHog+VB8vhpxF6W+y0HyyAgtnEYv3dKHfok+qXzhAvxp7YHq KxobKxq0yEHFaVmq4rq4p0OPlDhvxn5yZ5KxDZllY5eLSqQmKWqoybzw9OhaoOdxk/ UC0LGdu9olnUj4NxhHSLYUQHhGkXs90g09EtoSKAdEF1priJeyMU+N15Fo/odQ9rKQ WuissTVUqHezI9VePetKjAtBvw5U4x+GHZb1A4Ad/yW2dmim4Jv8J1ESZe+LgbIMko DA0kXFbT1KbLJ3j+5Hc09NBH90CmmE1SQmzIdb8HPcbevClgzNMG1naycgaJ4APxTx Wn0nn/+lhksrA== From: AngeloGioacchino Del Regno To: pavel@ucw.cz Cc: lee@kernel.org, sean.wang@mediatek.com, robh+dt@kernel.org, krzysztof.kozlowski+dt@linaro.org, matthias.bgg@gmail.com, linux-leds@vger.kernel.org, devicetree@vger.kernel.org, linux-arm-kernel@lists.infradead.org, linux-mediatek@lists.infradead.org, linux-kernel@vger.kernel.org, kernel@collabora.com, AngeloGioacchino Del Regno Subject: [PATCH v3 8/8] leds: leds-mt6323: Add support for WLEDs and MT6332 Date: Thu, 1 Jun 2023 13:08:13 +0200 Message-Id: <20230601110813.2373764-9-angelogioacchino.delregno@collabora.com> X-Mailer: git-send-email 2.40.1 In-Reply-To: <20230601110813.2373764-1-angelogioacchino.delregno@collabora.com> References: <20230601110813.2373764-1-angelogioacchino.delregno@collabora.com> MIME-Version: 1.0 Content-Transfer-Encoding: quoted-printable Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Content-Type: text/plain; charset="utf-8" Add basic code to turn on and off WLEDs and wire up MT6332 support to take advantage of it. This is a simple approach due to the aforementioned PMIC supporting only on/off status so, at the time of writing, it is impossible for me to validate more advanced functionality due to lack of hardware. Signed-off-by: AngeloGioacchino Del Regno --- drivers/leds/leds-mt6323.c | 171 +++++++++++++++++++++++++++++++++++-- 1 file changed, 164 insertions(+), 7 deletions(-) diff --git a/drivers/leds/leds-mt6323.c b/drivers/leds/leds-mt6323.c index 85b056fcd94e..e8fecfc2e90a 100644 --- a/drivers/leds/leds-mt6323.c +++ b/drivers/leds/leds-mt6323.c @@ -20,6 +20,11 @@ #define RG_DRV_32K_CK_PDN BIT(11) #define RG_DRV_32K_CK_PDN_MASK BIT(11) =20 +/* 32K/1M/6M clock common for WLED device */ +#define RG_VWLED_1M_CK_PDN BIT(0) +#define RG_VWLED_32K_CK_PDN BIT(12) +#define RG_VWLED_6M_CK_PDN BIT(13) + /* * Register field for TOP_CKPDN2 to enable * individual clock for LED device. @@ -71,7 +76,7 @@ struct mt6323_led { int id; struct mt6323_leds *parent; struct led_classdev cdev; - enum led_brightness current_brightness; + unsigned int current_brightness; }; =20 /** @@ -84,6 +89,7 @@ struct mt6323_led { * @num_isink_con: Number of ISINKx_CON registers * @isink_max_regs: Number of ISINK[0..x] registers * @isink_en_ctrl: Offset to ISINK_EN_CTRL register + * @iwled_en_ctrl: Offset to IWLED_EN_CTRL register */ struct mt6323_regs { const u16 *top_ckpdn; @@ -94,18 +100,21 @@ struct mt6323_regs { u8 num_isink_con; u8 isink_max_regs; u16 isink_en_ctrl; + u16 iwled_en_ctrl; }; =20 /** * struct mt6323_hwspec - hardware specific parameters * @max_period: Maximum period for all LEDs * @max_leds: Maximum number of supported LEDs + * @max_wleds: Maximum number of WLEDs * @max_brightness: Maximum brightness for all LEDs * @unit_duty: Steps of duty per period */ struct mt6323_hwspec { u16 max_period; u8 max_leds; + u8 max_wleds; u16 max_brightness; u16 unit_duty; }; @@ -377,6 +386,117 @@ static int mt6323_led_set_brightness(struct led_class= dev *cdev, return ret; } =20 +static int mtk_wled_hw_on(struct led_classdev *cdev) +{ + struct mt6323_led *led =3D container_of(cdev, struct mt6323_led, cdev); + struct mt6323_leds *leds =3D led->parent; + const struct mt6323_regs *regs =3D leds->pdata->regs; + struct regmap *regmap =3D leds->hw->regmap; + int ret; + + ret =3D regmap_clear_bits(regmap, regs->top_ckpdn[0], RG_VWLED_32K_CK_PDN= ); + if (ret) + return ret; + + ret =3D regmap_clear_bits(regmap, regs->top_ckpdn[0], RG_VWLED_6M_CK_PDN); + if (ret) + return ret; + + ret =3D regmap_clear_bits(regmap, regs->top_ckpdn[0], RG_VWLED_1M_CK_PDN); + if (ret) + return ret; + + usleep_range(5000, 6000); + + /* Enable WLED channel pair */ + ret =3D regmap_set_bits(regmap, regs->iwled_en_ctrl, BIT(led->id)); + if (ret) + return ret; + + ret =3D regmap_set_bits(regmap, regs->iwled_en_ctrl, BIT(led->id + 1)); + if (ret) + return ret; + + return 0; +} + +static int mtk_wled_hw_off(struct led_classdev *cdev) +{ + struct mt6323_led *led =3D container_of(cdev, struct mt6323_led, cdev); + struct mt6323_leds *leds =3D led->parent; + const struct mt6323_regs *regs =3D leds->pdata->regs; + struct regmap *regmap =3D leds->hw->regmap; + int ret; + + ret =3D regmap_clear_bits(regmap, regs->iwled_en_ctrl, BIT(led->id + 1)); + if (ret) + return ret; + + ret =3D regmap_clear_bits(regmap, regs->iwled_en_ctrl, BIT(led->id)); + if (ret) + return ret; + + ret =3D regmap_set_bits(regmap, regs->top_ckpdn[0], RG_VWLED_32K_CK_PDN); + if (ret) + return ret; + + ret =3D regmap_set_bits(regmap, regs->top_ckpdn[0], RG_VWLED_6M_CK_PDN); + if (ret) + return ret; + + ret =3D regmap_set_bits(regmap, regs->top_ckpdn[0], RG_VWLED_1M_CK_PDN); + if (ret) + return ret; + + return 0; +} + +static unsigned int mt6323_get_wled_brightness(struct led_classdev *cdev) +{ + struct mt6323_led *led =3D container_of(cdev, struct mt6323_led, cdev); + struct mt6323_leds *leds =3D led->parent; + const struct mt6323_regs *regs =3D leds->pdata->regs; + struct regmap *regmap =3D leds->hw->regmap; + unsigned int status; + int ret; + + ret =3D regmap_read(regmap, regs->iwled_en_ctrl, &status); + if (ret) + return 0; + + /* Always two channels per WLED */ + status &=3D BIT(led->id) | BIT(led->id + 1); + + return status ? led->current_brightness : 0; +} + +static int mt6323_wled_set_brightness(struct led_classdev *cdev, + unsigned int brightness) +{ + struct mt6323_led *led =3D container_of(cdev, struct mt6323_led, cdev); + struct mt6323_leds *leds =3D led->parent; + int ret =3D 0; + + mutex_lock(&leds->lock); + + if (brightness) { + if (!led->current_brightness) + ret =3D mtk_wled_hw_on(cdev); + if (ret) + goto out; + } else { + ret =3D mtk_wled_hw_off(cdev); + if (ret) + goto out; + } + + led->current_brightness =3D brightness; +out: + mutex_unlock(&leds->lock); + + return ret; +} + static int mt6323_led_set_dt_default(struct led_classdev *cdev, struct device_node *np) { @@ -416,6 +536,7 @@ static int mt6323_led_probe(struct platform_device *pde= v) int ret; unsigned int status; u32 reg; + u8 max_leds; =20 leds =3D devm_kzalloc(dev, sizeof(*leds), GFP_KERNEL); if (!leds) @@ -426,6 +547,7 @@ static int mt6323_led_probe(struct platform_device *pde= v) leds->pdata =3D device_get_match_data(dev); regs =3D leds->pdata->regs; spec =3D leds->pdata->spec; + max_leds =3D spec->max_leds + spec->max_wleds; =20 /* * leds->hw points to the underlying bus for the register @@ -445,6 +567,7 @@ static int mt6323_led_probe(struct platform_device *pde= v) =20 for_each_available_child_of_node(np, child) { struct led_init_data init_data =3D {}; + bool is_wled; =20 ret =3D of_property_read_u32(child, "reg", ®); if (ret) { @@ -452,7 +575,7 @@ static int mt6323_led_probe(struct platform_device *pde= v) goto put_child_node; } =20 - if (reg >=3D spec->max_leds || reg >=3D MAX_SUPPORTED_LEDS || + if (reg >=3D max_leds || reg >=3D MAX_SUPPORTED_LEDS || leds->led[reg]) { dev_err(dev, "Invalid led reg %u\n", reg); ret =3D -EINVAL; @@ -465,14 +588,24 @@ static int mt6323_led_probe(struct platform_device *p= dev) goto put_child_node; } =20 + is_wled =3D of_property_read_bool(child, "mediatek,is-wled"); + leds->led[reg] =3D led; leds->led[reg]->id =3D reg; leds->led[reg]->cdev.max_brightness =3D spec->max_brightness; - leds->led[reg]->cdev.brightness_set_blocking =3D - mt6323_led_set_brightness; - leds->led[reg]->cdev.blink_set =3D mt6323_led_set_blink; - leds->led[reg]->cdev.brightness_get =3D - mt6323_get_led_hw_brightness; + + if (is_wled) { + leds->led[reg]->cdev.brightness_set_blocking =3D + mt6323_wled_set_brightness; + leds->led[reg]->cdev.brightness_get =3D + mt6323_get_wled_brightness; + } else { + leds->led[reg]->cdev.brightness_set_blocking =3D + mt6323_led_set_brightness; + leds->led[reg]->cdev.blink_set =3D mt6323_led_set_blink; + leds->led[reg]->cdev.brightness_get =3D + mt6323_get_led_hw_brightness; + } leds->led[reg]->parent =3D leds; =20 ret =3D mt6323_led_set_dt_default(&leds->led[reg]->cdev, child); @@ -540,6 +673,17 @@ static const struct mt6323_regs mt6331_registers =3D { .isink_en_ctrl =3D 0x43a, }; =20 +static const struct mt6323_regs mt6332_registers =3D { + .top_ckpdn =3D (const u16[]){ 0x8094, 0x809a, 0x80a0 }, + .num_top_ckpdn =3D 3, + .top_ckcon =3D (const u16[]){ 0x80a6, 0x80ac }, + .num_top_ckcon =3D 2, + .isink_con =3D (const u16[]){ 0x8cd4 }, + .num_isink_con =3D 1, + .isink_max_regs =3D 12, /* IWLED[0..2, 3..9] */ + .iwled_en_ctrl =3D 0x8cda, +}; + static const struct mt6323_hwspec mt6323_spec =3D { .max_period =3D 10000, .max_leds =3D 4, @@ -547,6 +691,13 @@ static const struct mt6323_hwspec mt6323_spec =3D { .unit_duty =3D 3125, }; =20 +static const struct mt6323_hwspec mt6332_spec =3D { + /* There are no LEDs in MT6332. Only WLEDs are present. */ + .max_leds =3D 0, + .max_wleds =3D 1, + .max_brightness =3D 1024, +}; + static const struct mt6323_data mt6323_pdata =3D { .regs =3D &mt6323_registers, .spec =3D &mt6323_spec, @@ -557,9 +708,15 @@ static const struct mt6323_data mt6331_pdata =3D { .spec =3D &mt6323_spec, }; =20 +static const struct mt6323_data mt6332_pdata =3D { + .regs =3D &mt6332_registers, + .spec =3D &mt6332_spec, +}; + static const struct of_device_id mt6323_led_dt_match[] =3D { { .compatible =3D "mediatek,mt6323-led", .data =3D &mt6323_pdata}, { .compatible =3D "mediatek,mt6331-led", .data =3D &mt6331_pdata }, + { .compatible =3D "mediatek,mt6332-led", .data =3D &mt6332_pdata }, {}, }; MODULE_DEVICE_TABLE(of, mt6323_led_dt_match); --=20 2.40.1