LXR linux/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/irqs.h>
  19#include <mach/i2c.h>
  20
  21static int set_clock_run(struct platform_device *pdev)
  22{
  23        struct clk *clk;
  24        char name[10];
  25        int retval = 0;
  26
  27        snprintf(name, 10, "i2c%d_ck", pdev->id);
  28        clk = clk_get(&pdev->dev, name);
  29        if (!IS_ERR(clk)) {
  30                clk_set_rate(clk, 1);
  31                clk_put(clk);
  32        } else
  33                retval = -ENOENT;
  34
  35        return retval;
  36}
  37
  38static int set_clock_stop(struct platform_device *pdev)
  39{
  40        struct clk *clk;
  41        char name[10];
  42        int retval = 0;
  43
  44        snprintf(name, 10, "i2c%d_ck", pdev->id);
  45        clk = clk_get(&pdev->dev, name);
  46        if (!IS_ERR(clk)) {
  47                clk_set_rate(clk, 0);
  48                clk_put(clk);
  49        } else
  50                retval = -ENOENT;
  51
  52        return retval;
  53}
  54
  55static int i2c_pnx_suspend(struct platform_device *pdev, pm_message_t state)
  56{
  57        int retval = 0;
  58#ifdef CONFIG_PM
  59        retval = set_clock_run(pdev);
  60#endif
  61        return retval;
  62}
  63
  64static int i2c_pnx_resume(struct platform_device *pdev)
  65{
  66        int retval = 0;
  67#ifdef CONFIG_PM
  68        retval = set_clock_run(pdev);
  69#endif
  70        return retval;
  71}
  72
  73static u32 calculate_input_freq(struct platform_device *pdev)
  74{
  75        return HCLK_MHZ;
  76}
  77
  78
  79static struct i2c_pnx_algo_data pnx_algo_data0 = {
  80        .base = PNX4008_I2C1_BASE,
  81        .irq = I2C_1_INT,
  82};
  83
  84static struct i2c_pnx_algo_data pnx_algo_data1 = {
  85        .base = PNX4008_I2C2_BASE,
  86        .irq = I2C_2_INT,
  87};
  88
  89static struct i2c_pnx_algo_data pnx_algo_data2 = {
  90        .base = (PNX4008_USB_CONFIG_BASE + 0x300),
  91        .irq = USB_I2C_INT,
  92};
  93
  94static struct i2c_adapter pnx_adapter0 = {
  95        .name = I2C_CHIP_NAME "0",
  96        .algo_data = &pnx_algo_data0,
  97};
  98static struct i2c_adapter pnx_adapter1 = {
  99        .name = I2C_CHIP_NAME "1",
 100        .algo_data = &pnx_algo_data1,
 101};
 102
 103static struct i2c_adapter pnx_adapter2 = {
 104        .name = "USB-I2C",
 105        .algo_data = &pnx_algo_data2,
 106};
 107
 108static struct i2c_pnx_data i2c0_data = {
 109        .suspend = i2c_pnx_suspend,
 110        .resume = i2c_pnx_resume,
 111        .calculate_input_freq = calculate_input_freq,
 112        .set_clock_run = set_clock_run,
 113        .set_clock_stop = set_clock_stop,
 114        .adapter = &pnx_adapter0,
 115};
 116
 117static struct i2c_pnx_data i2c1_data = {
 118        .suspend = i2c_pnx_suspend,
 119        .resume = i2c_pnx_resume,
 120        .calculate_input_freq = calculate_input_freq,
 121        .set_clock_run = set_clock_run,
 122        .set_clock_stop = set_clock_stop,
 123        .adapter = &pnx_adapter1,
 124};
 125
 126static struct i2c_pnx_data i2c2_data = {
 127        .suspend = i2c_pnx_suspend,
 128        .resume = i2c_pnx_resume,
 129        .calculate_input_freq = calculate_input_freq,
 130        .set_clock_run = set_clock_run,
 131        .set_clock_stop = set_clock_stop,
 132        .adapter = &pnx_adapter2,
 133};
 134
 135static struct platform_device i2c0_device = {
 136        .name = "pnx-i2c",
 137        .id = 0,
 138        .dev = {
 139                .platform_data = &i2c0_data,
 140        },
 141};
 142
 143static struct platform_device i2c1_device = {
 144        .name = "pnx-i2c",
 145        .id = 1,
 146        .dev = {
 147                .platform_data = &i2c1_data,
 148        },
 149};
 150
 151static struct platform_device i2c2_device = {
 152        .name = "pnx-i2c",
 153        .id = 2,
 154        .dev = {
 155                .platform_data = &i2c2_data,
 156        },
 157};
 158
 159static struct platform_device *devices[] __initdata = {
 160        &i2c0_device,
 161        &i2c1_device,
 162        &i2c2_device,
 163};
 164
 165void __init pnx4008_register_i2c_devices(void)
 166{
 167        platform_add_devices(devices, ARRAY_SIZE(devices));
 168}
 169