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     else if (rate <= 100)\r
  84         {\r
  85          // iomux pwm2           \r
  86          rk29_mux_api_set(pdata->pwm_iomux_name, pdata->pwm_iomux_pwm);\r
  87                  \r
  88          pwm_write_reg(id,PWM_REG_CTRL, PWM_DIV|PWM_RESET);\r
  89          divh = clkrate / nHz;\r
  90          divh = divh >> (1+(PWM_DIV>>9));\r
  91          pwm_write_reg(id,PWM_REG_LRC,(divh == 0)?1:divh);\r
  92                  \r
  93          divTotal =pwm_read_reg(id,PWM_REG_LRC);\r
  94          divh = divTotal*rate/100;\r
  95          pwm_write_reg(id, PWM_REG_HRC, divh?divh:1);\r
  96          pwm_write_reg(id,PWM_REG_CNTR,0);\r
  97          pwm_write_reg(id, PWM_REG_CTRL,pwm_read_reg(id,PWM_REG_CTRL)|PWM_DIV|PWM_ENABLE|PWM_TimeEN);\r
  98         }\r
  99      else\r
 100         {\r
 101         return -1;\r
 102         }\r
 103 \r
 104         usleep_range(10*1000, 10*1000);\r
 105         \r
 106         \r
 107     return (0);\r
 108 }\r
 109 \r
 110 static int pwm_regulator_list_voltage(struct regulator_dev *dev,unsigned int index)\r
 111 {\r
 112        DBG("Enter %s, index =%d\n",__FUNCTION__,index);\r
 113        if (index < sizeof(pwm_voltage_map)/sizeof(int))\r
 114                 return pwm_voltage_map[index];\r
 115         else\r
 116                 return -1;\r
 117 }\r
 118 \r
 119 static int pwm_regulator_is_enabled(struct regulator_dev *dev)\r
 120 {\r
 121         DBG("Enter %s\n",__FUNCTION__);\r
 122         return 0;\r
 123 }
 124
 125 static int pwm_regulator_enable(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_disable(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_get_voltage(struct regulator_dev *dev)\r
 138 {\r
 139        struct pwm_platform_data *pdata = rdev_get_drvdata(dev);\r
 140            \r
 141         DBG("Enter %s\n",__FUNCTION__);  \r
 142         \r
 143         return (pdata->pwm_voltage*1000);\r
 144 }
 145
 146 static int pwm_regulator_set_voltage(struct regulator_dev *dev,\r
 147                                   int min_uV, int max_uV)\r
 148 {          \r
 149         struct pwm_platform_data *pdata = rdev_get_drvdata(dev);\r
 150         \r
 151        const int *voltage_map = pwm_voltage_map;\r
 152            \r
 153        int min_mV = min_uV /1000, max_mA = max_uV / 1000;\r
 154            \r
 155         u32 size = sizeof(pwm_voltage_map)/sizeof(int), i, vol,pwm_value;\r
 156 \r
 157         DBG("%s:  min_uV = %d, max_uV = %d\n",__FUNCTION__, min_uV,max_uV);\r
 158 \r
 159         if (min_mV < voltage_map[0] ||max_mA > voltage_map[size-1])\r
 160                 return -EINVAL;
 161
 162         for (i = 0; i < size; i++)\r
 163         {\r
 164                 if (voltage_map[i] >= min_mV)\r
 165                         break;
 166         }\r
 167
 168 \r
 169        vol =  voltage_map[i];\r
 170 \r
 171        pdata->pwm_voltage = vol;\r
 172            \r
 173         // VDD12 = 1.4 - 0.476*D , ÆäÖÐDÎªPWMÕ¼¿Õ±È, \r
 174         pwm_value = 100*(1400-vol)/476;  // pwm_value %\r
 175 \r
 176            \r
 177         if (pwm_set_rate(pdata,1000*1000,pwm_value)!=0)\r
 178                 return -1;\r
 179 \r
 180        return 0;\r
 181 \r
 182 }
 183
 184 static struct regulator_ops pwm_voltage_ops = {\r
 185         .list_voltage   = pwm_regulator_list_voltage,\r
 186         .set_voltage    =pwm_regulator_set_voltage,\r
 187         .get_voltage    = pwm_regulator_get_voltage,\r
 188         .enable         = pwm_regulator_enable,\r
 189         .disable        = pwm_regulator_disable,\r
 190         .is_enabled     = pwm_regulator_is_enabled,\r
 191 };\r
 192
 193 static struct regulator_desc pwm_regulator= {\r
 194                 .name = "pwm-regulator",\r
 195                 .ops = &pwm_voltage_ops,\r
 196                 .type = REGULATOR_VOLTAGE,\r
 197 };\r
 198
 199 static int __devinit pwm_regulator_probe(struct platform_device *pdev)\r
 200 {\r
 201 \r
 202         struct pwm_platform_data *pdata = pdev->dev.platform_data;\r
 203         struct regulator_dev *rdev;\r
 204         int ret ;\r
 205
 206         if (!pdata)
 207                 return -ENODEV;
 208
 209         if (!pdata->pwm_voltage)
 210                 pdata->pwm_voltage = 1200;      // default 1.2v
 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