From patchwork Mon Jun 3 15:38:34 2013 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Alexander Shiyan X-Patchwork-Id: 2653601 Return-Path: X-Original-To: patchwork-linux-arm@patchwork.kernel.org Delivered-To: patchwork-process-083081@patchwork1.kernel.org Received: from casper.infradead.org (casper.infradead.org [85.118.1.10]) by patchwork1.kernel.org (Postfix) with ESMTP id A38AA3FC23 for ; Mon, 3 Jun 2013 16:07:43 +0000 (UTC) Received: from merlin.infradead.org ([2001:4978:20e::2]) by casper.infradead.org with esmtps (Exim 4.80.1 #2 (Red Hat Linux)) id 1UjWv1-0007LS-7p; Mon, 03 Jun 2013 15:43:43 +0000 Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.80.1 #2 (Red Hat Linux)) id 1UjWrA-0003c0-4h; Mon, 03 Jun 2013 15:39:36 +0000 Received: from smtp2.mail.ru ([94.100.176.130]) by merlin.infradead.org with esmtps (Exim 4.80.1 #2 (Red Hat Linux)) id 1UjWqu-0003ZM-8j for linux-arm-kernel@lists.infradead.org; Mon, 03 Jun 2013 15:39:23 +0000 DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=mail.ru; s=mail2; h=Message-Id:Date:Subject:Cc:To:From; bh=OTGddTT4UWgwM2Z1nEXUlJUz1jUF+aYHmMlc7L5gwE8=; b=JDTVNsANnp1r15s6TY94mkoAu3vVOYUkz4NUqpFFnJhajmK2EMqzVuNhhO2aUaNc5kRecvHODXjX0lIVlALe6nky1zJnXZ4L6+a6KP3NV0kkZBn4zYQVxJH2NNU5l7h/QTYtlb/AThK5YC1HioNup3iS+ataVCzkKeN2zlzsD34=; Received: from [188.134.40.128] (port=21661 helo=shc.zet) by smtp2.mail.ru with esmtpa (envelope-from ) id 1UjWqW-0005gS-Qn; Mon, 03 Jun 2013 19:38:57 +0400 From: Alexander Shiyan To: linux-arm-kernel@lists.infradead.org Subject: [PATCH 1/3] leds: leds-mc13783: Prepare driver to support MC13892 LEDs Date: Mon, 3 Jun 2013 19:38:34 +0400 Message-Id: <1370273916-29852-1-git-send-email-shc_work@mail.ru> X-Mailer: git-send-email 1.8.1.5 X-Spam: Not detected X-Mras: Ok X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20130603_113920_910904_EB436497 X-CRM114-Status: GOOD ( 18.64 ) X-Spam-Score: -2.0 (--) X-Spam-Report: SpamAssassin version 3.3.2 on merlin.infradead.org summary: Content analysis details: (-2.0 points) pts rule name description ---- ---------------------- -------------------------------------------------- -0.0 RCVD_IN_DNSWL_NONE RBL: Sender listed at http://www.dnswl.org/, no trust [94.100.176.130 listed in list.dnswl.org] 0.0 FREEMAIL_FROM Sender email is commonly abused enduser mail provider (shc_work[at]mail.ru) -0.0 SPF_PASS SPF: sender matches SPF record -1.9 BAYES_00 BODY: Bayes spam probability is 0 to 1% [score: 0.0000] -0.1 DKIM_VALID_AU Message has a valid DKIM or DK signature from author's domain 0.1 DKIM_SIGNED Message has a DKIM or DK signature, not necessarily valid -0.1 DKIM_VALID Message has at least one valid DKIM or DK signature Cc: Russell King , Alexander Shiyan , Bryan Wu , Richard Purdie , Sascha Hauer , linux-leds@vger.kernel.org X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.15 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org This patch prepares driver code to support MC13892 LEDs. Some stuff was optimized for support another PMIC, some dependencies was moved into devdata calls. Signed-off-by: Alexander Shiyan --- drivers/leds/leds-mc13783.c | 201 +++++++++++++++++++++++++------------------- include/linux/mfd/mc13xxx.h | 1 - 2 files changed, 113 insertions(+), 89 deletions(-) diff --git a/drivers/leds/leds-mc13783.c b/drivers/leds/leds-mc13783.c index ea8fc5d..449940d 100644 --- a/drivers/leds/leds-mc13783.c +++ b/drivers/leds/leds-mc13783.c @@ -24,7 +24,14 @@ #include #include -struct mc13783_led { +struct mc13xxx_led_devtype { + int led_min; + int led_max; + int (*leds_startup)(struct platform_device *); + void (*leds_shutdown)(struct platform_device *); +}; + +struct mc13xxx_led { struct led_classdev cdev; struct work_struct work; struct mc13xxx *master; @@ -32,7 +39,7 @@ struct mc13783_led { int id; }; -#define MC13783_REG_LED_CONTROL_0 51 +#define MC13XXX_REG_LED_CONTROL_0 51 #define MC13783_LED_C0_ENABLE_BIT (1 << 0) #define MC13783_LED_C0_TRIODE_MD_BIT (1 << 7) #define MC13783_LED_C0_TRIODE_AD_BIT (1 << 8) @@ -43,10 +50,10 @@ struct mc13783_led { #define MC13783_LED_C0_ABREF_MASK 0x3 #define MC13783_LED_C0_ABREF 14 -#define MC13783_REG_LED_CONTROL_1 52 +#define MC13XXX_REG_LED_CONTROL_1 52 #define MC13783_LED_C1_TC1HALF_BIT (1 << 18) -#define MC13783_REG_LED_CONTROL_2 53 +#define MC13XXX_REG_LED_CONTROL_2 53 #define MC13783_LED_C2_BL_P_MASK 0xf #define MC13783_LED_C2_MD_P 9 #define MC13783_LED_C2_AD_P 13 @@ -56,7 +63,7 @@ struct mc13783_led { #define MC13783_LED_C2_AD_C 3 #define MC13783_LED_C2_KP_C 6 -#define MC13783_REG_LED_CONTROL_3 54 +#define MC13XXX_REG_LED_CONTROL_3 54 #define MC13783_LED_C3_TC_P 6 #define MC13783_LED_C3_TC_P_MASK 0x1f @@ -69,29 +76,29 @@ struct mc13783_led { #define MC13783_LED_Cx_TRIODE_TC_BIT (1 << 23) #define MC13783_LED_Cx_TC_C_MASK 0x3 -static void mc13783_led_work(struct work_struct *work) +static void mc13xxx_led_work(struct work_struct *work) { - struct mc13783_led *led = container_of(work, struct mc13783_led, work); - int reg = 0; - int mask = 0; - int value = 0; - int bank, off, shift; + struct mc13xxx_led *led = container_of(work, struct mc13xxx_led, work); + int reg, mask, value, bank, off, shift; switch (led->id) { case MC13783_LED_MD: - reg = MC13783_REG_LED_CONTROL_2; - mask = MC13783_LED_C2_BL_P_MASK << MC13783_LED_C2_MD_P; - value = (led->new_brightness >> 4) << MC13783_LED_C2_MD_P; + reg = MC13XXX_REG_LED_CONTROL_2; + mask = MC13783_LED_C2_BL_P_MASK; + shift = MC13783_LED_C2_MD_P; + value = led->new_brightness >> 4; break; case MC13783_LED_AD: - reg = MC13783_REG_LED_CONTROL_2; - mask = MC13783_LED_C2_BL_P_MASK << MC13783_LED_C2_AD_P; - value = (led->new_brightness >> 4) << MC13783_LED_C2_AD_P; + reg = MC13XXX_REG_LED_CONTROL_2; + mask = MC13783_LED_C2_BL_P_MASK; + shift = MC13783_LED_C2_AD_P; + value = led->new_brightness >> 4; break; case MC13783_LED_KP: - reg = MC13783_REG_LED_CONTROL_2; - mask = MC13783_LED_C2_BL_P_MASK << MC13783_LED_C2_KP_P; - value = (led->new_brightness >> 4) << MC13783_LED_C2_KP_P; + reg = MC13XXX_REG_LED_CONTROL_2; + mask = MC13783_LED_C2_BL_P_MASK; + shift = MC13783_LED_C2_KP_P; + value = led->new_brightness >> 4; break; case MC13783_LED_R1: case MC13783_LED_G1: @@ -103,57 +110,51 @@ static void mc13783_led_work(struct work_struct *work) case MC13783_LED_G3: case MC13783_LED_B3: off = led->id - MC13783_LED_R1; - bank = off/3; - reg = MC13783_REG_LED_CONTROL_3 + off/3; - shift = (off - bank * 3) * 5 + MC13783_LED_C3_TC_P; - value = (led->new_brightness >> 3) << shift; - mask = MC13783_LED_C3_TC_P_MASK << shift; + bank = off / 3; + reg = MC13XXX_REG_LED_CONTROL_3 + bank; + shift = (off - bank * 3) * 5 + MC13783_LED_C3_TC_P; + value = led->new_brightness >> 3; + mask = MC13783_LED_C3_TC_P_MASK; break; + default: + BUG(); } mc13xxx_lock(led->master); - - mc13xxx_reg_rmw(led->master, reg, mask, value); - + mc13xxx_reg_rmw(led->master, reg, mask << shift, + value << shift); mc13xxx_unlock(led->master); } -static void mc13783_led_set(struct led_classdev *led_cdev, - enum led_brightness value) +static void mc13xxx_led_set(struct led_classdev *led_cdev, + enum led_brightness value) { - struct mc13783_led *led; + struct mc13xxx_led *led = + container_of(led_cdev, struct mc13xxx_led, cdev); - led = container_of(led_cdev, struct mc13783_led, cdev); led->new_brightness = value; schedule_work(&led->work); } -static int mc13783_led_setup(struct mc13783_led *led, int max_current) +static int mc13xxx_led_setup(struct mc13xxx_led *led, int max_current) { - int shift = 0; - int mask = 0; - int value = 0; - int reg = 0; - int ret, bank; + int shift, mask, reg, ret, bank; switch (led->id) { case MC13783_LED_MD: shift = MC13783_LED_C2_MD_C; mask = MC13783_LED_C2_BL_C_MASK; - value = max_current & MC13783_LED_C2_BL_C_MASK; - reg = MC13783_REG_LED_CONTROL_2; + reg = MC13XXX_REG_LED_CONTROL_2; break; case MC13783_LED_AD: shift = MC13783_LED_C2_AD_C; mask = MC13783_LED_C2_BL_C_MASK; - value = max_current & MC13783_LED_C2_BL_C_MASK; - reg = MC13783_REG_LED_CONTROL_2; + reg = MC13XXX_REG_LED_CONTROL_2; break; case MC13783_LED_KP: shift = MC13783_LED_C2_KP_C; mask = MC13783_LED_C2_BL_C_MASK; - value = max_current & MC13783_LED_C2_BL_C_MASK; - reg = MC13783_REG_LED_CONTROL_2; + reg = MC13XXX_REG_LED_CONTROL_2; break; case MC13783_LED_R1: case MC13783_LED_G1: @@ -164,29 +165,28 @@ static int mc13783_led_setup(struct mc13783_led *led, int max_current) case MC13783_LED_R3: case MC13783_LED_G3: case MC13783_LED_B3: - bank = (led->id - MC13783_LED_R1)/3; - reg = MC13783_REG_LED_CONTROL_3 + bank; + bank = (led->id - MC13783_LED_R1) / 3; + reg = MC13XXX_REG_LED_CONTROL_3 + bank; shift = ((led->id - MC13783_LED_R1) - bank * 3) * 2; mask = MC13783_LED_Cx_TC_C_MASK; - value = max_current & MC13783_LED_Cx_TC_C_MASK; break; + default: + BUG(); } mc13xxx_lock(led->master); - ret = mc13xxx_reg_rmw(led->master, reg, mask << shift, - value << shift); - + (max_current & mask) << shift); mc13xxx_unlock(led->master); + return ret; } -static int mc13783_leds_prepare(struct platform_device *pdev) +static int mc13783_leds_startup(struct platform_device *pdev) { struct mc13xxx_leds_platform_data *pdata = dev_get_platdata(&pdev->dev); struct mc13xxx *dev = dev_get_drvdata(pdev->dev.parent); - int ret = 0; - int reg = 0; + int ret, reg = 0; mc13xxx_lock(dev); @@ -196,7 +196,7 @@ static int mc13783_leds_prepare(struct platform_device *pdev) if (pdata->flags & MC13783_LED_SLEWLIMTC) reg |= MC13783_LED_Cx_SLEWLIM_BIT; - ret = mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_1, reg); + ret = mc13xxx_reg_write(dev, MC13XXX_REG_LED_CONTROL_1, reg); if (ret) goto out; @@ -206,7 +206,7 @@ static int mc13783_leds_prepare(struct platform_device *pdev) if (pdata->flags & MC13783_LED_SLEWLIMBL) reg |= MC13783_LED_Cx_SLEWLIM_BIT; - ret = mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_2, reg); + ret = mc13xxx_reg_write(dev, MC13XXX_REG_LED_CONTROL_2, reg); if (ret) goto out; @@ -216,7 +216,7 @@ static int mc13783_leds_prepare(struct platform_device *pdev) if (pdata->flags & MC13783_LED_TRIODE_TC1) reg |= MC13783_LED_Cx_TRIODE_TC_BIT; - ret = mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_3, reg); + ret = mc13xxx_reg_write(dev, MC13XXX_REG_LED_CONTROL_3, reg); if (ret) goto out; @@ -255,27 +255,47 @@ static int mc13783_leds_prepare(struct platform_device *pdev) reg |= (pdata->abref & MC13783_LED_C0_ABREF_MASK) << MC13783_LED_C0_ABREF; - ret = mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_0, reg); + ret = mc13xxx_reg_write(dev, MC13XXX_REG_LED_CONTROL_0, reg); out: mc13xxx_unlock(dev); + return ret; } -static int mc13783_led_probe(struct platform_device *pdev) +static void mc13783_leds_shutdown(struct platform_device *pdev) +{ + struct mc13xxx *dev = dev_get_drvdata(pdev->dev.parent); + + mc13xxx_lock(dev); + + mc13xxx_reg_write(dev, MC13XXX_REG_LED_CONTROL_0, 0); + mc13xxx_reg_write(dev, MC13XXX_REG_LED_CONTROL_1, 0); + mc13xxx_reg_write(dev, MC13XXX_REG_LED_CONTROL_2, 0); + mc13xxx_reg_write(dev, MC13XXX_REG_LED_CONTROL_3, 0); + mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_4, 0); + mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_5, 0); + + mc13xxx_unlock(dev); +} + +static int mc13xxx_led_probe(struct platform_device *pdev) { struct mc13xxx_leds_platform_data *pdata = dev_get_platdata(&pdev->dev); + struct mc13xxx_led_devtype *devtype = + (struct mc13xxx_led_devtype *)pdev->id_entry->driver_data; struct mc13xxx_led_platform_data *led_cur; - struct mc13783_led *led, *led_dat; + struct mc13xxx_led *led, *led_dat; + unsigned int init_led = 0; int ret, i; - int init_led = 0; if (pdata == NULL) { dev_err(&pdev->dev, "missing platform data\n"); return -ENODEV; } - if (pdata->num_leds < 1 || pdata->num_leds > (MC13783_LED_MAX + 1)) { + if ((pdata->num_leds < 1) || + (pdata->num_leds > (devtype->led_max - devtype->led_min + 1))) { dev_err(&pdev->dev, "Invalid led count %d\n", pdata->num_leds); return -EINVAL; } @@ -287,7 +307,7 @@ static int mc13783_led_probe(struct platform_device *pdev) return -ENOMEM; } - ret = mc13783_leds_prepare(pdev); + ret = devtype->leds_startup(pdev); if (ret) { dev_err(&pdev->dev, "unable to init led driver\n"); return ret; @@ -297,7 +317,8 @@ static int mc13783_led_probe(struct platform_device *pdev) led_dat = &led[i]; led_cur = &pdata->led[i]; - if (led_cur->id > MC13783_LED_MAX || led_cur->id < 0) { + if ((led_cur->id > devtype->led_max) || + (led_cur->id < devtype->led_min)) { dev_err(&pdev->dev, "invalid id %d\n", led_cur->id); ret = -EINVAL; goto err_register; @@ -313,12 +334,12 @@ static int mc13783_led_probe(struct platform_device *pdev) init_led |= 1 << led_cur->id; led_dat->cdev.name = led_cur->name; led_dat->cdev.default_trigger = led_cur->default_trigger; - led_dat->cdev.brightness_set = mc13783_led_set; + led_dat->cdev.brightness_set = mc13xxx_led_set; led_dat->cdev.brightness = LED_OFF; led_dat->id = led_cur->id; led_dat->master = dev_get_drvdata(pdev->dev.parent); - INIT_WORK(&led_dat->work, mc13783_led_work); + INIT_WORK(&led_dat->work, mc13xxx_led_work); ret = led_classdev_register(pdev->dev.parent, &led_dat->cdev); if (ret) { @@ -327,7 +348,7 @@ static int mc13783_led_probe(struct platform_device *pdev) goto err_register; } - ret = mc13783_led_setup(led_dat, led_cur->max_current); + ret = mc13xxx_led_setup(led_dat, led_cur->max_current); if (ret) { dev_err(&pdev->dev, "unable to init led %d\n", led_dat->id); @@ -341,51 +362,55 @@ static int mc13783_led_probe(struct platform_device *pdev) err_register: for (i = i - 1; i >= 0; i--) { - led_classdev_unregister(&led[i].cdev); cancel_work_sync(&led[i].work); + led_classdev_unregister(&led[i].cdev); } return ret; } -static int mc13783_led_remove(struct platform_device *pdev) +static int mc13xxx_led_remove(struct platform_device *pdev) { struct mc13xxx_leds_platform_data *pdata = dev_get_platdata(&pdev->dev); - struct mc13783_led *led = platform_get_drvdata(pdev); - struct mc13xxx *dev = dev_get_drvdata(pdev->dev.parent); + struct mc13xxx_led_devtype *devtype = + (struct mc13xxx_led_devtype *)pdev->id_entry->driver_data; + struct mc13xxx_led *led = platform_get_drvdata(pdev); int i; for (i = 0; i < pdata->num_leds; i++) { - led_classdev_unregister(&led[i].cdev); cancel_work_sync(&led[i].work); + led_classdev_unregister(&led[i].cdev); } - mc13xxx_lock(dev); - - mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_0, 0); - mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_1, 0); - mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_2, 0); - mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_3, 0); - mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_4, 0); - mc13xxx_reg_write(dev, MC13783_REG_LED_CONTROL_5, 0); - - mc13xxx_unlock(dev); + devtype->leds_shutdown(pdev); return 0; } -static struct platform_driver mc13783_led_driver = { +static const struct mc13xxx_led_devtype mc13783_led_devtype = { + .led_min = MC13783_LED_MD, + .led_max = MC13783_LED_B3, + .leds_startup = mc13783_leds_startup, + .leds_shutdown = mc13783_leds_shutdown, +}; + +static const struct platform_device_id mc13xxx_led_id_table[] = { + { "mc13783-led", (kernel_ulong_t)&mc13783_led_devtype, }, + { } +}; +MODULE_DEVICE_TABLE(platform, mc13xxx_led_id_table); + +static struct platform_driver mc13xxx_led_driver = { .driver = { - .name = "mc13783-led", + .name = "mc13xxx-led", .owner = THIS_MODULE, }, - .probe = mc13783_led_probe, - .remove = mc13783_led_remove, + .probe = mc13xxx_led_probe, + .remove = mc13xxx_led_remove, + .id_table = mc13xxx_led_id_table, }; - -module_platform_driver(mc13783_led_driver); +module_platform_driver(mc13xxx_led_driver); MODULE_DESCRIPTION("LEDs driver for Freescale MC13783 PMIC"); MODULE_AUTHOR("Philippe Retornaz "); MODULE_LICENSE("GPL"); -MODULE_ALIAS("platform:mc13783-led"); diff --git a/include/linux/mfd/mc13xxx.h b/include/linux/mfd/mc13xxx.h index bf07075..fe0e003 100644 --- a/include/linux/mfd/mc13xxx.h +++ b/include/linux/mfd/mc13xxx.h @@ -91,7 +91,6 @@ struct mc13xxx_led_platform_data { #define MC13783_LED_R3 9 #define MC13783_LED_G3 10 #define MC13783_LED_B3 11 -#define MC13783_LED_MAX MC13783_LED_B3 int id; const char *name; const char *default_trigger;