drivers/regulator/rk29-pwm-regulator.c

   1 /* drivers/regulator/rk29-pwm-regulator.c\r
   2  *
   3  * Copyright (C) 2010 ROCKCHIP, Inc.
   4  *
   5  * This software is licensed under the terms of the GNU General Public
   6  * License version 2, as published by the Free Software Foundation, and
   7  * may be copied, distributed, and modified under those terms.
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  */
  15 /*******************************************************************/
  16 /*        COPYRIGHT (C)  ROCK-CHIPS FUZHOU . ALL RIGHTS RESERVED.                         */
  17 /*******************************************************************
  18 FILE            :               rk29-pwm-regulator.c\r
  19 DESC            :       rk29 pwm regulator driver\r
  20 AUTHOR          :       hxy\r
  21 DATE            :       2010-12-20\r
  22 NOTES           :
  23 $LOG: GPIO.C,V $
  24 REVISION 0.01
  25 ********************************************************************/
  26
  27
  28 #include <linux/bug.h>
  29 #include <linux/err.h>\r
  30 #include <linux/platform_device.h>\r
  31 #include <linux/kernel.h>\r
  32 #include <linux/clk.h>\r
  33 #include <asm/io.h>\r
  34 #include <linux/delay.h>\r
  35 #include <linux/regulator/driver.h>
  36 #include <linux/regulator/rk29-pwm-regulator.h>\r
  37 #include <mach/iomux.h>\r
  38 #include <linux/gpio.h>\r
  39
  40
  41 #if 0
  42 #define DBG(x...)       printk(KERN_INFO x)
  43 #else
  44 #define DBG(x...)
  45 #endif
  46 \r
  47 \r
  48 #define         PWM_VCORE_120           40\r
  49 #define         PWM_VCORE_125           32\r
  50 #define PWM_VCORE_130           21\r
  51 #define PWM_VCORE_135           10\r
  52 #define PWM_VCORE_140           0\r
  53 \r
  54 \r
  55 #define pwm_write_reg(id, addr, val)                    __raw_writel(val, addr+(RK29_PWM_BASE+id*0x10)) \r
  56 #define pwm_read_reg(id, addr)                          __raw_readl(addr+(RK29_PWM_BASE+id*0x10))\r
  57 \r
  58 \r
  59 const static int pwm_voltage_map[] = {\r
  60         950, 975, 1000, 1025, 1050, 1075, 1100, 1125, 1150, 1175, 1200, 1225, 1250, 1275, 1300, 1325, 1350, 1375, 1400\r
  61 };\r
  62 \r
  63 static struct clk *pwm_clk;\r
  64 \r
  65 static int pwm_set_rate(struct pwm_platform_data *pdata,int nHz,u32 rate)\r
  66 {\r
  67     u32 divh,divTotal;\r
  68     int id = pdata->pwm_id;\r
  69     unsigned long clkrate;\r
  70 \r
  71     clkrate = clk_get_rate(pwm_clk);\r
  72         \r
  73     if ( id >3 || id <0 )\r
  74         return -1;\r
  75 \r
  76     if(rate == 0)\r
  77         {\r
  78          // iomux pwm2 to gpio2_a[3]     \r
  79          rk29_mux_api_set(pdata->pwm_iomux_name, pdata->pwm_iomux_gpio);\r
  80          // set gpio to low level        \r
  81          gpio_set_value(pdata->pwm_gpio,GPIO_LOW);\r
  82 \r
  83          pdata->pwm_voltage = 1400;\r
  84          \r
  85         }\r
  86     else if (rate <= 100)\r
  87         {\r
  88          // iomux pwm2           \r
  89          rk29_mux_api_set(pdata->pwm_iomux_name, pdata->pwm_iomux_pwm);\r
  90                  \r
  91          pwm_write_reg(id,PWM_REG_CTRL, PWM_DIV|PWM_RESET);\r
  92          divh = clkrate / nHz;\r
  93          divh = divh >> (1+(PWM_DIV>>9));\r
  94          pwm_write_reg(id,PWM_REG_LRC,(divh == 0)?1:divh);\r
  95                  \r
  96          divTotal =pwm_read_reg(id,PWM_REG_LRC);\r
  97          divh = divTotal*rate/100;\r
  98          pwm_write_reg(id, PWM_REG_HRC, divh?divh:1);\r
  99          pwm_write_reg(id,PWM_REG_CNTR,0);\r
 100          pwm_write_reg(id, PWM_REG_CTRL,pwm_read_reg(id,PWM_REG_CTRL)|PWM_DIV|PWM_ENABLE|PWM_TimeEN);\r
 101 \r
 102          pdata->pwm_voltage = 1400 - 476*rate/100;\r
 103          \r
 104         }\r
 105      else\r
 106         {\r
 107         return -1;\r
 108         }\r
 109 \r
 110         msleep(10);\r
 111         \r
 112         \r
 113     return (0);\r
 114 }\r
 115 \r
 116 static int pwm_regulator_list_voltage(struct regulator_dev *dev,unsigned int index)\r
 117 {\r
 118        DBG("Enter %s, index =%d\n",__FUNCTION__,index);\r
 119        if (index < sizeof(pwm_voltage_map)/sizeof(int))\r
 120                 return pwm_voltage_map[index];\r
 121         else\r
 122                 return -1;\r
 123 }\r
 124 \r
 125 static int pwm_regulator_is_enabled(struct regulator_dev *dev)\r
 126 {\r
 127         DBG("Enter %s\n",__FUNCTION__);\r
 128         return 0;\r
 129 }
 130
 131 static int pwm_regulator_enable(struct regulator_dev *dev)\r
 132 {\r
 133         DBG("Enter %s\n",__FUNCTION__);\r
 134         return 0;\r
 135 }
 136
 137 static int pwm_regulator_disable(struct regulator_dev *dev)\r
 138 {\r
 139         DBG("Enter %s\n",__FUNCTION__);\r
 140         return 0;\r
 141 }
 142
 143 static int pwm_regulator_get_voltage(struct regulator_dev *dev)\r
 144 {\r
 145        struct pwm_platform_data *pdata = rdev_get_drvdata(dev);\r
 146            \r
 147         DBG("Enter %s\n",__FUNCTION__);  \r
 148         \r
 149         return (pdata->pwm_voltage*1000);\r
 150 }
 151
 152 static int pwm_regulator_set_voltage(struct regulator_dev *dev,\r
 153                                   int min_uV, int max_uV)\r
 154 {          \r
 155         struct pwm_platform_data *pdata = rdev_get_drvdata(dev);\r
 156         \r
 157        const int *voltage_map = pwm_voltage_map;\r
 158            \r
 159        int min_mV = min_uV /1000, max_mA = max_uV / 1000;\r
 160            \r
 161         u32 size = sizeof(pwm_voltage_map)/sizeof(int), i, vol,pwm_value;\r
 162 \r
 163         DBG("%s:  min_uV = %d, max_uV = %d\n",__FUNCTION__, min_uV,max_uV);\r
 164 \r
 165         if (min_mV < voltage_map[0] ||max_mA > voltage_map[size-1])\r
 166                 return -EINVAL;
 167
 168         for (i = 0; i < size; i++)\r
 169         {\r
 170                 if (voltage_map[i] >= min_mV)\r
 171                         break;
 172         }\r
 173
 174 \r
 175        vol =  voltage_map[i];\r
 176 \r
 177        pdata->pwm_voltage = vol;\r
 178            \r
 179         // VDD12 = 1.4 - 0.476*D , ÆäÖÐDÎªPWMÕ¼¿Õ±È, \r
 180         pwm_value = 100*(1400-vol)/476;  // pwm_value %\r
 181 \r
 182            \r
 183         if (pwm_set_rate(pdata,1000*1000,pwm_value)!=0)\r
 184                 return -1;\r
 185 \r
 186        return 0;\r
 187 \r
 188 }
 189
 190 static struct regulator_ops pwm_voltage_ops = {\r
 191         .list_voltage   = pwm_regulator_list_voltage,\r
 192         .set_voltage    =pwm_regulator_set_voltage,\r
 193         .get_voltage    = pwm_regulator_get_voltage,\r
 194         .enable         = pwm_regulator_enable,\r
 195         .disable        = pwm_regulator_disable,\r
 196         .is_enabled     = pwm_regulator_is_enabled,\r
 197 };\r
 198
 199 static struct regulator_desc pwm_regulator= {\r
 200                 .name = "pwm-regulator",\r
 201                 .ops = &pwm_voltage_ops,\r
 202                 .type = REGULATOR_VOLTAGE,\r
 203 };\r
 204
 205 static int __devinit pwm_regulator_probe(struct platform_device *pdev)\r
 206 {\r
 207 \r
 208         struct pwm_platform_data *pdata = pdev->dev.platform_data;\r
 209         struct regulator_dev *rdev;\r
 210         int ret ;\r
 211
 212         rdev = regulator_register(&pwm_regulator, &pdev->dev,\r
 213                                 pdata->init_data, pdata);\r
 214         if (IS_ERR(rdev)) {\r
 215                 dev_dbg(&pdev->dev, "couldn't register regulator\n");
 216                 return PTR_ERR(rdev);\r
 217         }\r
 218         \r
 219        ret = gpio_request(pdata->pwm_gpio,"pwm");\r
 220 \r
 221         if (ret) {\r
 222                         dev_err(&pdev->dev,"failed to request pwm gpio\n");\r
 223                         goto err_gpio;\r
 224                 }\r
 225 \r
 226         pwm_clk = clk_get(NULL, "pwm");\r
 227         clk_enable(pwm_clk);\r
 228 \r
 229 \r
 230         platform_set_drvdata(pdev, rdev);\r
 231         printk(KERN_INFO "pwm_regulator: driver initialized\n");\r
 232 \r
 233         return 0;\r
 234 \r
 235         \r
 236 err_gpio:\r
 237         gpio_free(pdata->pwm_gpio);\r
 238 \r
 239 \r
 240         return ret;\r
 241 \r
 242 }
 243 static int __devexit pwm_regulator_remove(struct platform_device *pdev)\r
 244 {\r
 245         struct pwm_platform_data *pdata = pdev->dev.platform_data;\r
 246         struct regulator_dev *rdev = platform_get_drvdata(pdev);\r
 247 \r
 248         regulator_unregister(rdev);\r
 249         gpio_free(pdata->pwm_gpio);\r
 250 \r
 251         return 0;\r
 252 }\r
 253 \r
 254 static struct platform_driver pwm_regulator_driver = {\r
 255         .driver = {\r
 256                 .name = "pwm-voltage-regulator",\r
 257         },\r
 258         .remove = __devexit_p(pwm_regulator_remove),\r
 259 };\r
 260
 261 \r
 262 static int __init pwm_regulator_module_init(void)\r
 263 {
 264         return platform_driver_probe(&pwm_regulator_driver, pwm_regulator_probe);\r
 265 }
 266
 267 static void __exit pwm_regulator_module_exit(void)\r
 268 {
 269         platform_driver_unregister(&pwm_regulator_driver);\r
 270 }
 271 \r
 272 \r
 273 subsys_initcall(pwm_regulator_module_init);\r
 274 \r
 275 module_exit(pwm_regulator_module_exit);\r
 276
 277 MODULE_LICENSE("GPL");
 278 MODULE_AUTHOR("hxy <hxy@rock-chips.com>");\r
 279 MODULE_DESCRIPTION("k29 pwm change driver");\r