1f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy/* 2f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * Copyright (C) ST-Ericsson SA 2010 3f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * 4f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * Author: Arun R Murthy <arun.murthy@stericsson.com> 5f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * License terms: GNU General Public License (GPL) version 2 6f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy */ 7f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy#include <linux/err.h> 8f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy#include <linux/platform_device.h> 9f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy#include <linux/slab.h> 10f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy#include <linux/pwm.h> 11f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy#include <linux/mfd/abx500.h> 12ee66e653ca7425bc8ffca4e00f19a8057cd14e4dLinus Walleij#include <linux/mfd/abx500/ab8500.h> 13eb12a679b242c03b9eaa38a67cae9fa3e17ddea6Paul Gortmaker#include <linux/module.h> 14f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 15f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy/* 16f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * PWM Out generators 17f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * Bank: 0x10 18f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy */ 19f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy#define AB8500_PWM_OUT_CTRL1_REG 0x60 20f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy#define AB8500_PWM_OUT_CTRL2_REG 0x61 21f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy#define AB8500_PWM_OUT_CTRL7_REG 0x66 22f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 236173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Redingstruct ab8500_pwm_chip { 246173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding struct pwm_chip chip; 25f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy}; 26f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 276173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Redingstatic int ab8500_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm, 286173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding int duty_ns, int period_ns) 29f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy{ 30f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy int ret = 0; 31f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy unsigned int higher_val, lower_val; 32f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy u8 reg; 33f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 34f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy /* 35f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * get the first 8 bits that are be written to 36f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * AB8500_PWM_OUT_CTRL1_REG[0:7] 37f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy */ 38f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy lower_val = duty_ns & 0x00FF; 39f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy /* 40f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * get bits [9:10] that are to be written to 41f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * AB8500_PWM_OUT_CTRL2_REG[0:1] 42f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy */ 43f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy higher_val = ((duty_ns & 0x0300) >> 8); 44f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 456173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding reg = AB8500_PWM_OUT_CTRL1_REG + ((chip->base - 1) * 2); 46f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 476173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding ret = abx500_set_register_interruptible(chip->dev, AB8500_MISC, 48f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy reg, (u8)lower_val); 49f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy if (ret < 0) 50f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy return ret; 516173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding ret = abx500_set_register_interruptible(chip->dev, AB8500_MISC, 52f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy (reg + 1), (u8)higher_val); 53f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 54f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy return ret; 55f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy} 56f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 576173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Redingstatic int ab8500_pwm_enable(struct pwm_chip *chip, struct pwm_device *pwm) 58f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy{ 59f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy int ret; 60f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 616173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding ret = abx500_mask_and_set_register_interruptible(chip->dev, 62f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy AB8500_MISC, AB8500_PWM_OUT_CTRL7_REG, 6354b02347d71802a010ceace3dd25ed3774ba8a1eAxel Lin 1 << (chip->base - 1), 1 << (chip->base - 1)); 64f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy if (ret < 0) 65622fc5d4452a20aab7b8f5107c2931c5610e5753Axel Lin dev_err(chip->dev, "%s: Failed to enable PWM, Error %d\n", 66f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy pwm->label, ret); 67f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy return ret; 68f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy} 69f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 706173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Redingstatic void ab8500_pwm_disable(struct pwm_chip *chip, struct pwm_device *pwm) 71f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy{ 72f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy int ret; 73f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 746173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding ret = abx500_mask_and_set_register_interruptible(chip->dev, 75f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy AB8500_MISC, AB8500_PWM_OUT_CTRL7_REG, 7654b02347d71802a010ceace3dd25ed3774ba8a1eAxel Lin 1 << (chip->base - 1), 0); 77f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy if (ret < 0) 786173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding dev_err(chip->dev, "%s: Failed to disable PWM, Error %d\n", 79f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy pwm->label, ret); 80f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy} 81f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 826173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Redingstatic const struct pwm_ops ab8500_pwm_ops = { 836173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding .config = ab8500_pwm_config, 846173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding .enable = ab8500_pwm_enable, 856173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding .disable = ab8500_pwm_disable, 86fa0abee9b89e3a0bab207823bd16372de53c3896Axel Lin .owner = THIS_MODULE, 876173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding}; 88f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 893e9fe83d278cce6974f0a4d1870c0ff4a0b74ba5Bill Pembertonstatic int ab8500_pwm_probe(struct platform_device *pdev) 90f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy{ 916173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding struct ab8500_pwm_chip *ab8500; 926173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding int err; 936173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding 94f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy /* 95f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * Nothing to be done in probe, this is required to get the 96f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy * device which is required for ab8500 read and write 97f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy */ 98482467ad97b633b28f57c347440d97c108dc4bfbJingoo Han ab8500 = devm_kzalloc(&pdev->dev, sizeof(*ab8500), GFP_KERNEL); 99a2fc1db61a651cd9b9dce2622562eadcc9e1e15cJingoo Han if (ab8500 == NULL) 100f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy return -ENOMEM; 1016173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding 1026173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding ab8500->chip.dev = &pdev->dev; 1036173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding ab8500->chip.ops = &ab8500_pwm_ops; 1046173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding ab8500->chip.base = pdev->id; 1056173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding ab8500->chip.npwm = 1; 1066173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding 1076173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding err = pwmchip_add(&ab8500->chip); 108482467ad97b633b28f57c347440d97c108dc4bfbJingoo Han if (err < 0) 1096173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding return err; 1106173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding 1116173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding dev_dbg(&pdev->dev, "pwm probe successful\n"); 1126173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding platform_set_drvdata(pdev, ab8500); 1136173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding 114f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy return 0; 115f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy} 116f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 11777f37917a6f2bd8635b553178bb34bdd80f08e40Bill Pembertonstatic int ab8500_pwm_remove(struct platform_device *pdev) 118f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy{ 1196173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding struct ab8500_pwm_chip *ab8500 = platform_get_drvdata(pdev); 1206173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding int err; 1216173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding 1226173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding err = pwmchip_remove(&ab8500->chip); 1236173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding if (err < 0) 1246173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding return err; 1256173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding 126f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy dev_dbg(&pdev->dev, "pwm driver removed\n"); 1276173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Reding 128f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy return 0; 129f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy} 130f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 131f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthystatic struct platform_driver ab8500_pwm_driver = { 132f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy .driver = { 133f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy .name = "ab8500-pwm", 134f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy .owner = THIS_MODULE, 135f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy }, 136f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy .probe = ab8500_pwm_probe, 137fd1091125a1d11fcc635749d0d3dec36904a7a48Bill Pemberton .remove = ab8500_pwm_remove, 138f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy}; 1396173f8f4ed9c2bd4184908e35f46755a0d14b0f2Thierry Redingmodule_platform_driver(ab8500_pwm_driver); 140f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun Murthy 141f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun MurthyMODULE_AUTHOR("Arun MURTHY <arun.murthy@stericsson.com>"); 142f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun MurthyMODULE_DESCRIPTION("AB8500 Pulse Width Modulation Driver"); 14337b7bf67c36d3a2b426c0cb2787d948949574103Axel LinMODULE_ALIAS("platform:ab8500-pwm"); 144f0f05b1c751772d19c9c8f36d75e97b1d9687407Arun MurthyMODULE_LICENSE("GPL v2"); 145