arch/arm/mach-pnx4008/i2c.c

   1 /*
   2  * I2C initialization for PNX4008.
   3  *
   4  * Author: Vitaly Wool <vitalywool@gmail.com>
   5  *
   6  * 2005-2006 (c) MontaVista Software, Inc. This file is licensed under
   7  * the terms of the GNU General Public License version 2. This program
   8  * is licensed "as is" without any warranty of any kind, whether express
   9  * or implied.
  10  */
  11
  12 #include <linux/clk.h>
  13 #include <linux/i2c.h>
  14 #include <linux/i2c-pnx.h>
  15 #include <linux/platform_device.h>
  16 #include <linux/err.h>
  17 #include <mach/platform.h>
  18 #include <mach/i2c.h>
  19
  20 static int set_clock_run(struct platform_device *pdev)
  21 {
  22         struct clk *clk;
  23         char name[10];
  24         int retval = 0;
  25
  26         snprintf(name, 10, "i2c%d_ck", pdev->id);
  27         clk = clk_get(&pdev->dev, name);
  28         if (!IS_ERR(clk)) {
  29                 clk_set_rate(clk, 1);
  30                 clk_put(clk);
  31         } else
  32                 retval = -ENOENT;
  33
  34         return retval;
  35 }
  36
  37 static int set_clock_stop(struct platform_device *pdev)
  38 {
  39         struct clk *clk;
  40         char name[10];
  41         int retval = 0;
  42
  43         snprintf(name, 10, "i2c%d_ck", pdev->id);
  44         clk = clk_get(&pdev->dev, name);
  45         if (!IS_ERR(clk)) {
  46                 clk_set_rate(clk, 0);
  47                 clk_put(clk);
  48         } else
  49                 retval = -ENOENT;
  50
  51         return retval;
  52 }
  53
  54 static int i2c_pnx_suspend(struct platform_device *pdev, pm_message_t state)
  55 {
  56         int retval = 0;
  57 #ifdef CONFIG_PM
  58         retval = set_clock_run(pdev);
  59 #endif
  60         return retval;
  61 }
  62
  63 static int i2c_pnx_resume(struct platform_device *pdev)
  64 {
  65         int retval = 0;
  66 #ifdef CONFIG_PM
  67         retval = set_clock_run(pdev);
  68 #endif
  69         return retval;
  70 }
  71
  72 static u32 calculate_input_freq(struct platform_device *pdev)
  73 {
  74         return HCLK_MHZ;
  75 }
  76
  77
  78 static struct i2c_pnx_algo_data pnx_algo_data0 = {
  79         .base = PNX4008_I2C1_BASE,
  80         .irq = I2C_1_INT,
  81 };
  82
  83 static struct i2c_pnx_algo_data pnx_algo_data1 = {
  84         .base = PNX4008_I2C2_BASE,
  85         .irq = I2C_2_INT,
  86 };
  87
  88 static struct i2c_pnx_algo_data pnx_algo_data2 = {
  89         .base = (PNX4008_USB_CONFIG_BASE + 0x300),
  90         .irq = USB_I2C_INT,
  91 };
  92
  93 static struct i2c_adapter pnx_adapter0 = {
  94         .name = I2C_CHIP_NAME "0",
  95         .algo_data = &pnx_algo_data0,
  96 };
  97 static struct i2c_adapter pnx_adapter1 = {
  98         .name = I2C_CHIP_NAME "1",
  99         .algo_data = &pnx_algo_data1,
 100 };
 101
 102 static struct i2c_adapter pnx_adapter2 = {
 103         .name = "USB-I2C",
 104         .algo_data = &pnx_algo_data2,
 105 };
 106
 107 static struct i2c_pnx_data i2c0_data = {
 108         .suspend = i2c_pnx_suspend,
 109         .resume = i2c_pnx_resume,
 110         .calculate_input_freq = calculate_input_freq,
 111         .set_clock_run = set_clock_run,
 112         .set_clock_stop = set_clock_stop,
 113         .adapter = &pnx_adapter0,
 114 };
 115
 116 static struct i2c_pnx_data i2c1_data = {
 117         .suspend = i2c_pnx_suspend,
 118         .resume = i2c_pnx_resume,
 119         .calculate_input_freq = calculate_input_freq,
 120         .set_clock_run = set_clock_run,
 121         .set_clock_stop = set_clock_stop,
 122         .adapter = &pnx_adapter1,
 123 };
 124
 125 static struct i2c_pnx_data i2c2_data = {
 126         .suspend = i2c_pnx_suspend,
 127         .resume = i2c_pnx_resume,
 128         .calculate_input_freq = calculate_input_freq,
 129         .set_clock_run = set_clock_run,
 130         .set_clock_stop = set_clock_stop,
 131         .adapter = &pnx_adapter2,
 132 };
 133
 134 static struct platform_device i2c0_device = {
 135         .name = "pnx-i2c",
 136         .id = 0,
 137         .dev = {
 138                 .platform_data = &i2c0_data,
 139         },
 140 };
 141
 142 static struct platform_device i2c1_device = {
 143         .name = "pnx-i2c",
 144         .id = 1,
 145         .dev = {
 146                 .platform_data = &i2c1_data,
 147         },
 148 };
 149
 150 static struct platform_device i2c2_device = {
 151         .name = "pnx-i2c",
 152         .id = 2,
 153         .dev = {
 154                 .platform_data = &i2c2_data,
 155         },
 156 };
 157
 158 static struct platform_device *devices[] __initdata = {
 159         &i2c0_device,
 160         &i2c1_device,
 161         &i2c2_device,
 162 };
 163
 164 void __init pnx4008_register_i2c_devices(void)
 165 {
 166         platform_add_devices(devices, ARRAY_SIZE(devices));
 167 }