drivers/mfd/rt5025-misc.c

   1 /*
   2  *  drivers/mfd/rt5025-misc.c
   3  *  Driver foo Richtek RT5025 PMIC Misc Part
   4  *
   5  *  Copyright (C) 2013 Richtek Electronics
   6  *  cy_huang <cy_huang@richtek.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2 as
  10  * published by the Free Software Foundation.
  11  */
  12
  13 #include <linux/module.h>
  14 #include <linux/kernel.h>
  15 #include <linux/err.h>
  16 #include <linux/i2c.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/slab.h>
  19
  20 #include <linux/mfd/rt5025.h>
  21 #include <linux/mfd/rt5025-misc.h>
  22
  23 struct rt5025_misc_info {
  24         struct i2c_client *i2c;
  25 };
  26
  27 static struct i2c_client *g_shdn;
  28 void rt5025_power_off(void)
  29 {
  30         rt5025_reg_write(g_shdn, RT5025_CHENH_REG, 0x00);
  31         rt5025_reg_write(g_shdn, RT5025_CHENL_REG, 0x80);
  32         rt5025_set_bits(g_shdn, RT5025_SHDNCTRL_REG, RT5025_SHDNCTRL_MASK);
  33 }
  34 EXPORT_SYMBOL(rt5025_power_off);
  35
  36 int rt5025_cable_exist(void)
  37 {
  38         int ret = 0;
  39         ret = rt5025_reg_read(g_shdn, 0x01);
  40         if (ret < 0)
  41                 return 0;
  42         else
  43         {
  44                 if (ret&0x3)
  45                         return 1;
  46                 return 0;
  47         }
  48 }
  49 EXPORT_SYMBOL(rt5025_cable_exist);
  50
  51 static int __devinit rt5025_misc_reg_init(struct i2c_client *client, struct rt5025_misc_data *md)
  52 {
  53         int ret = 0;
  54
  55         rt5025_reg_write(client, RT5025_RESETCTRL_REG, md->RSTCtrl.val);
  56         rt5025_assign_bits(client, RT5025_VSYSULVO_REG, RT5025_VSYSOFF_MASK, md->VSYSCtrl.val);
  57         rt5025_reg_write(client, RT5025_PWRONCTRL_REG, md->PwrOnCfg.val);
  58         rt5025_reg_write(client, RT5025_SHDNCTRL_REG, md->SHDNCtrl.val);
  59         rt5025_reg_write(client, RT5025_PWROFFEN_REG, md->PwrOffCond.val);
  60
  61         return ret;
  62 }
  63
  64 static int __devinit rt5025_misc_probe(struct platform_device *pdev)
  65 {
  66         struct rt5025_chip *chip = dev_get_drvdata(pdev->dev.parent);
  67         struct rt5025_platform_data *pdata = chip->dev->platform_data;
  68         struct rt5025_misc_info *mi;
  69
  70         mi = kzalloc(sizeof(*mi), GFP_KERNEL);
  71         if (!mi)
  72                 return -ENOMEM;
  73
  74         mi->i2c = chip->i2c;
  75         rt5025_misc_reg_init(mi->i2c, pdata->misc_data);
  76
  77         //for shutdown control
  78         g_shdn = chip->i2c;
  79
  80         platform_set_drvdata(pdev, mi);
  81         return 0;
  82 }
  83
  84 static int __devexit rt5025_misc_remove(struct platform_device *pdev)
  85 {
  86         struct rt5025_misc_info *mi = platform_get_drvdata(pdev);
  87
  88         kfree(mi);
  89         platform_set_drvdata(pdev, NULL);
  90         return 0;
  91 }
  92
  93 static struct platform_driver rt5025_misc_driver =
  94 {
  95         .driver = {
  96                 .name = RT5025_DEVICE_NAME "-misc",
  97                 .owner = THIS_MODULE,
  98         },
  99         .probe = rt5025_misc_probe,
 100         .remove = __devexit_p(rt5025_misc_remove),
 101 };
 102
 103 static int __init rt5025_misc_init(void)
 104 {
 105         return platform_driver_register(&rt5025_misc_driver);
 106 }
 107 module_init(rt5025_misc_init);
 108
 109 static void __exit rt5025_misc_exit(void)
 110 {
 111         platform_driver_unregister(&rt5025_misc_driver);
 112 }
 113 module_exit(rt5025_misc_exit);
 114
 115 MODULE_LICENSE("GPL v2");
 116 MODULE_AUTHOR("CY Huang <cy_huang@richtek.com");
 117 MODULE_DESCRIPTION("Misc driver for RT5025");
 118 MODULE_ALIAS("platform:" RT5025_DEVICE_NAME "-misc");
 119 MODULE_VERSION(RT5025_DRV_VER);