From patchwork Mon Nov 15 09:11:07 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Patchwork-Submitter: =?utf-8?b?UmFmYcWCIE1pxYJlY2tp?= X-Patchwork-Id: 12692560 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 mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 6E711C433EF for ; Mon, 15 Nov 2021 09:40:32 +0000 (UTC) Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 22274615E2 for ; Mon, 15 Nov 2021 09:40:32 +0000 (UTC) DMARC-Filter: OpenDMARC Filter v1.4.1 mail.kernel.org 22274615E2 Authentication-Results: mail.kernel.org; dmarc=fail (p=none dis=none) header.from=gmail.com Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender: Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-Id:Date:Subject:Cc:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=SgkMO4kPlfCxRUqR6mmBTgTJKNMRKD970eN3CAVQmhA=; b=OAe9p8ce3VqfzR o03zUVw/Cv4VkBHWwDckXs6JvEg/b+n0og/4OZNAZabUiH+6val8WYNyay5g8KwS1nZKu77bcMJYp 1oLCWa4kvu3D5qCNq3zM0x6g4idNmb2KjjEdOK6gildWwsp8lR6MQWiNfNsfl8l2qBn40LjU3Ei40 4eiNzevrse2A0I4dk1L9Y1N/mFf3BegK7ZQoUFA6iRNo1WJrXVAxk1ra01DCYoMgHTSqmWzlA1mrR JTB5fDoyroBtqGfPliBTDVsPE1z2IFGln48ny10i6U1bMOwB+6EaOHHgcA3HzoUQNEzq+OzJ1IoRI 3FOKgHlEAsKoJcDsleNA==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.94.2 #2 (Red Hat Linux)) id 1mmYRc-00Exkf-4m; Mon, 15 Nov 2021 09:38:32 +0000 Received: from mail-lf1-x12a.google.com ([2a00:1450:4864:20::12a]) by bombadil.infradead.org with esmtps (Exim 4.94.2 #2 (Red Hat Linux)) id 1mmY1E-00ErIq-25 for linux-arm-kernel@lists.infradead.org; Mon, 15 Nov 2021 09:11:18 +0000 Received: by mail-lf1-x12a.google.com with SMTP id bu18so41848577lfb.0 for ; Mon, 15 Nov 2021 01:11:15 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20210112; h=from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=LpDcWm5PVVzNg5mB3j8VkHSlSYlXc2aBZ8IPw2RSQwI=; b=pyCtbjZbONzI1Ts18fOd3nsr9mFUdHDk6wU05MuKfwnQCWFvHy6d/2AFB7wgfO2Znk JuCSiueg0NMINa5kvXAkA602Ew5Ljgd1fyR65SrkXQbgYzr7VcJ3LDpY3RHicfj3KM+F yGwYIUGuNyJmMW+FSLHGj52xuCPjx+YKh78gGwtL3rGU4YQ3MQWNQuSM19Lw56jKJWmR fF5fiKXcXErGj7xSRVrFUdXyTNKQo1JDPiBhqlwfw0gSf6BDGIlApSNtZ7+FeUvTC+9f vNG9uEdBalKYkuTvjqR2BQ4lwvbSob1NR3dt+QLA+4Zn+EJSXFZNtdc+uZOEQkJPdkOs WraQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=LpDcWm5PVVzNg5mB3j8VkHSlSYlXc2aBZ8IPw2RSQwI=; b=giPQiHyP5VkqItppM7O8MQpnVJPQLt96JjfhoHHCktraV/aCmfqVwbRaLlCGTYODK9 g+fOUfjLNMN0a3JQK1YFWJRnT8fD40ALssF5kz/3bzt37rB7tgFLqNcsO7RPateLcddE Z5+ovy2jxEmCZ2BplZmrMNbvchYqJKgJxKoY3heLPR4j/jgTz28lmoePipf5Krd1atVP sq7MnfA9QUNwV6vNwh2Wpbly+9pDZoTI+mLdnNObq5x+L8VL+ktb1Lj4wWeo1r0ZGQTS x3f9/D1EY2dNkv38q1AnMTyRPRMim69FACvp7xTV1cGPF6uoj2c1/rBZV8Mthi8xDD7e zxJA== X-Gm-Message-State: AOAM53293WSN6QHyogu3gxG904CyIwk3d6dzCdCvaECcpjkTb2brMKla k1Hdmmd0V7bXtBaidI9y65s= X-Google-Smtp-Source: ABdhPJxoc0GxHSVpFd/GVdSjuxuuTDH53jdIKA7Ns0lHsSlu4PT5jmiD5N7py5gxXAkN7pYrbox2YQ== X-Received: by 2002:a19:c30e:: with SMTP id t14mr33938927lff.375.1636967474089; Mon, 15 Nov 2021 01:11:14 -0800 (PST) Received: from localhost.lan (ip-194-187-74-233.konfederacka.maverick.com.pl. [194.187.74.233]) by smtp.gmail.com with ESMTPSA id 18sm503318ljd.73.2021.11.15.01.11.13 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 15 Nov 2021 01:11:13 -0800 (PST) From: =?utf-8?b?UmFmYcWCIE1pxYJlY2tp?= To: Pavel Machek , Rob Herring Cc: linux-leds@vger.kernel.org, devicetree@vger.kernel.org, Florian Fainelli , linux-arm-kernel@lists.infradead.org, bcm-kernel-feedback-list@broadcom.com, =?utf-8?b?UmFmYcWCIE1pxYJlY2tp?= Subject: [PATCH 2/2] leds: bcm63xxx: add support for BCM63xxx controller Date: Mon, 15 Nov 2021 10:11:07 +0100 Message-Id: <20211115091107.11737-2-zajec5@gmail.com> X-Mailer: git-send-email 2.31.1 In-Reply-To: <20211115091107.11737-1-zajec5@gmail.com> References: <20211115091107.11737-1-zajec5@gmail.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20211115_011116_164869_CE32490B X-CRM114-Status: GOOD ( 27.22 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: Rafał Miłecki It's a new controller used on BCM4908, some BCM68xx and some BCM63xxx SoCs. Signed-off-by: Rafał Miłecki --- drivers/leds/Kconfig | 11 ++ drivers/leds/Makefile | 1 + drivers/leds/leds-bcm63xxx.c | 299 +++++++++++++++++++++++++++++++++++ 3 files changed, 311 insertions(+) create mode 100644 drivers/leds/leds-bcm63xxx.c diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig index ed800f5da7d8..b4a35b58eaae 100644 --- a/drivers/leds/Kconfig +++ b/drivers/leds/Kconfig @@ -122,6 +122,17 @@ config LEDS_BCM6358 This option enables support for LEDs connected to the BCM6358 LED HW controller accessed via MMIO registers. +config LEDS_BCM63XXX + tristate "LED Support for Broadcom BCM63xxx SoCs" + depends on LEDS_CLASS + depends on ARCH_BCM4908 || BCM63XX || COMPILE_TEST + depends on HAS_IOMEM + depends on OF + default ARCH_BCM4908 + help + This option enables support for LED controller that is part of + BCM63xxx family SoCs. + config LEDS_CPCAP tristate "LED Support for Motorola CPCAP" depends on LEDS_CLASS diff --git a/drivers/leds/Makefile b/drivers/leds/Makefile index c636ec069612..b8f1b30e8398 100644 --- a/drivers/leds/Makefile +++ b/drivers/leds/Makefile @@ -18,6 +18,7 @@ obj-$(CONFIG_LEDS_ASIC3) += leds-asic3.o obj-$(CONFIG_LEDS_AW2013) += leds-aw2013.o obj-$(CONFIG_LEDS_BCM6328) += leds-bcm6328.o obj-$(CONFIG_LEDS_BCM6358) += leds-bcm6358.o +obj-$(CONFIG_LEDS_BCM63XXX) += leds-bcm63xxx.o obj-$(CONFIG_LEDS_BD2802) += leds-bd2802.o obj-$(CONFIG_LEDS_BLINKM) += leds-blinkm.o obj-$(CONFIG_LEDS_CLEVO_MAIL) += leds-clevo-mail.o diff --git a/drivers/leds/leds-bcm63xxx.c b/drivers/leds/leds-bcm63xxx.c new file mode 100644 index 000000000000..5128b28b748d --- /dev/null +++ b/drivers/leds/leds-bcm63xxx.c @@ -0,0 +1,299 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Copyright (C) 2021 Rafał Miłecki + */ +#include +#include +#include +#include +#include +#include +#include +#include + +#define BCM63XXX_MAX_LEDS 32 + +#define BCM63XXX_GLB_CTRL 0x00 +#define BCM63XXX_MASK 0x04 +#define BCM63XXX_HW_LED_EN 0x08 +#define BCM63XXX_SERIAL_LED_SHIFT_SEL 0x0c +#define BCM63XXX_FLASH_RATE_CTRL1 0x10 +#define BCM63XXX_FLASH_RATE_CTRL2 0x14 +#define BCM63XXX_FLASH_RATE_CTRL3 0x18 +#define BCM63XXX_FLASH_RATE_CTRL4 0x1c +#define BCM63XXX_BRIGHT_CTRL1 0x20 +#define BCM63XXX_BRIGHT_CTRL2 0x24 +#define BCM63XXX_BRIGHT_CTRL3 0x28 +#define BCM63XXX_BRIGHT_CTRL4 0x2c +#define BCM63XXX_POWER_LED_CFG 0x30 +#define BCM63XXX_HW_POLARITY 0xb4 +#define BCM63XXX_SW_DATA 0xb8 +#define BCM63XXX_SW_POLARITY 0xbc +#define BCM63XXX_PARALLEL_LED_POLARITY 0xc0 +#define BCM63XXX_SERIAL_LED_POLARITY 0xc4 +#define BCM63XXX_HW_LED_STATUS 0xc8 +#define BCM63XXX_FLASH_CTRL_STATUS 0xcc +#define BCM63XXX_FLASH_BRT_CTRL 0xd0 +#define BCM63XXX_FLASH_P_LED_OUT_STATUS 0xd4 +#define BCM63XXX_FLASH_S_LED_OUT_STATUS 0xd8 + +struct bcm63xxx_leds { + struct device *dev; + void __iomem *base; + spinlock_t lock; +}; + +struct bcm63xxx_led { + struct bcm63xxx_leds *leds; + struct led_classdev cdev; + u32 pin; + bool active_low; +}; + +/* + * I/O access + */ + +static void bcm63xxx_leds_write(struct bcm63xxx_leds *leds, unsigned int reg, + u32 data) +{ + writel(data, leds->base + reg); +} + +static unsigned long bcm63xxx_leds_read(struct bcm63xxx_leds *leds, + unsigned int reg) +{ + return readl(leds->base + reg); +} + +static void bcm63xxx_leds_update_bits(struct bcm63xxx_leds *leds, + unsigned int reg, u32 mask, u32 val) +{ + WARN_ON(val & ~mask); + + bcm63xxx_leds_write(leds, reg, (bcm63xxx_leds_read(leds, reg) & ~mask) | (val & mask)); +} + +/* + * Helpers + */ + +static void bcm63xxx_leds_set_flash_rate(struct bcm63xxx_leds *leds, + struct bcm63xxx_led *led, + u8 value) +{ + int reg_offset = (led->pin >> 3) * 4; + int shift = (led->pin & 0xf) * 4; + + bcm63xxx_leds_update_bits(leds, BCM63XXX_FLASH_RATE_CTRL1 + reg_offset, + 0xf << shift, value << shift); +} + +static void bcm63xxx_leds_enable_led(struct bcm63xxx_leds *leds, + struct bcm63xxx_led *led, + enum led_brightness value) +{ + u32 bit = BIT(led->pin); + + bcm63xxx_leds_update_bits(leds, BCM63XXX_SW_DATA, bit, + value == LED_OFF ? 0 : bit); +} + +/* + * API callbacks + */ + +static void bcm63xxx_leds_brightness_set(struct led_classdev *led_cdev, + enum led_brightness value) +{ + struct bcm63xxx_led *led = container_of(led_cdev, struct bcm63xxx_led, cdev); + struct bcm63xxx_leds *leds = led->leds; + unsigned long flags; + + spin_lock_irqsave(&leds->lock, flags); + + bcm63xxx_leds_enable_led(leds, led, value); + if (value == LED_OFF) + bcm63xxx_leds_set_flash_rate(leds, led, 0); + + spin_unlock_irqrestore(&leds->lock, flags); +} + +static int bcm63xxx_leds_blink_set(struct led_classdev *led_cdev, + unsigned long *delay_on, + unsigned long *delay_off) +{ + struct bcm63xxx_led *led = container_of(led_cdev, struct bcm63xxx_led, cdev); + struct bcm63xxx_leds *leds = led->leds; + unsigned long flags; + u8 value; + + if (!*delay_on && !*delay_off) { + *delay_on = 640; + *delay_off = 640; + } + + if (*delay_on != *delay_off) { + dev_dbg(led_cdev->dev, "Blinking at unequal delays is not supported\n"); + return -EINVAL; + } + + switch (*delay_on) { + case 1152 ... 1408: /* 1280 ms ± 10% */ + value = 0x7; + break; + case 576 ... 704: /* 640 ms ± 10% */ + value = 0x6; + break; + case 288 ... 352: /* 320 ms ± 10% */ + value = 0x5; + break; + case 126 ... 154: /* 140 ms ± 10% */ + value = 0x4; + break; + case 59 ... 72: /* 65 ms ± 10% */ + value = 0x3; + break; + default: + dev_dbg(led_cdev->dev, "Blinking delay value %lu is unsupported\n", + *delay_on); + return -EINVAL; + } + + spin_lock_irqsave(&leds->lock, flags); + + bcm63xxx_leds_enable_led(leds, led, LED_FULL); + bcm63xxx_leds_set_flash_rate(leds, led, value); + + spin_unlock_irqrestore(&leds->lock, flags); + + return 0; +} + +/* + * LED driver + */ + +static int bcm63xxx_leds_create_led(struct bcm63xxx_leds *leds, struct device_node *np) +{ + struct led_init_data init_data = { + .fwnode = of_fwnode_handle(np), + }; + struct device *dev = leds->dev; + struct bcm63xxx_led *led; + struct pinctrl *pinctrl; + const char *state; + u32 bit; + int err; + + led = devm_kzalloc(dev, sizeof(*led), GFP_KERNEL); + if (!led) + return -ENOMEM; + + led->leds = leds; + + if (of_property_read_u32(np, "reg", &led->pin)) { + dev_err(dev, "Missing \"reg\" property in %pOF\n", np); + err = -ENOENT; + goto err_out; + } + + if (led->pin >= BCM63XXX_MAX_LEDS) { + dev_err(dev, "Invalid \"reg\" value %d\n", led->pin); + err = -EINVAL; + goto err_out; + } + + led->active_low = of_property_read_bool(np, "active-low"); + + if (!of_property_read_string(np, "default-state", &state)) { + if (!strcmp(state, "on")) + led->cdev.brightness = LED_FULL; + else + led->cdev.brightness = LED_OFF; + } else { + led->cdev.brightness = LED_OFF; + } + + led->cdev.brightness_set = bcm63xxx_leds_brightness_set; + led->cdev.blink_set = bcm63xxx_leds_blink_set; + + err = devm_led_classdev_register_ext(dev, &led->cdev, &init_data); + if (err) { + dev_err(dev, "Failed to register LED %pOF: %d\n", np, err); + goto err_out; + } + + pinctrl = devm_pinctrl_get_select_default(led->cdev.dev); + if (IS_ERR(pinctrl) && PTR_ERR(pinctrl) != -ENODEV) { + dev_warn(led->cdev.dev, "Failed to select %pOF pinctrl: %ld\n", + np, PTR_ERR(pinctrl)); + } + + bit = BIT(led->pin); + bcm63xxx_leds_update_bits(leds, BCM63XXX_PARALLEL_LED_POLARITY, bit, + led->active_low ? 0 : bit); + bcm63xxx_leds_update_bits(leds, BCM63XXX_HW_LED_EN, bit, 0); + bcm63xxx_leds_set_flash_rate(leds, led, 0); + bcm63xxx_leds_enable_led(leds, led, led->cdev.brightness); + + return 0; + +err_out: + devm_kfree(dev, led); + return err; +} + +static int bcm63xxx_leds_probe(struct platform_device *pdev) +{ + struct device_node *np = dev_of_node(&pdev->dev); + struct device *dev = &pdev->dev; + struct bcm63xxx_leds *leds; + struct device_node *child; + + leds = devm_kzalloc(dev, sizeof(*leds), GFP_KERNEL); + if (!leds) + return -ENOMEM; + + leds->dev = dev; + + leds->base = devm_platform_ioremap_resource(pdev, 0); + if (IS_ERR(leds->base)) + return PTR_ERR(leds->base); + + spin_lock_init(&leds->lock); + + bcm63xxx_leds_write(leds, BCM63XXX_GLB_CTRL, 0xa); + bcm63xxx_leds_write(leds, BCM63XXX_BRIGHT_CTRL1, 0x88888888); + bcm63xxx_leds_write(leds, BCM63XXX_BRIGHT_CTRL2, 0x88888888); + bcm63xxx_leds_write(leds, BCM63XXX_BRIGHT_CTRL3, 0x88888888); + bcm63xxx_leds_write(leds, BCM63XXX_BRIGHT_CTRL4, 0x88888888); + bcm63xxx_leds_write(leds, BCM63XXX_HW_LED_EN, 0); + bcm63xxx_leds_write(leds, BCM63XXX_SERIAL_LED_POLARITY, 0); + bcm63xxx_leds_write(leds, BCM63XXX_PARALLEL_LED_POLARITY, 0); + + for_each_available_child_of_node(np, child) { + bcm63xxx_leds_create_led(leds, child); + } + + return 0; +} + +static const struct of_device_id bcm63xxx_leds_of_match_table[] = { + { .compatible = "brcm,bcm63xxx-leds", }, + { }, +}; + +static struct platform_driver bcm63xxx_leds_driver = { + .probe = bcm63xxx_leds_probe, + .driver = { + .name = "leds-bcm63xxx", + .of_match_table = bcm63xxx_leds_of_match_table, + }, +}; + +module_platform_driver(bcm63xxx_leds_driver); + +MODULE_AUTHOR("Rafał Miłecki"); +MODULE_LICENSE("GPL"); +MODULE_DEVICE_TABLE(of, bcm63xxx_leds_of_match_table);