Commit | Line | Data |
---|---|---|
41561f28 VW |
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> | |
a09e64fb | 17 | #include <mach/platform.h> |
18b2085e | 18 | #include <mach/irqs.h> |
a09e64fb | 19 | #include <mach/i2c.h> |
41561f28 VW |
20 | |
21 | static 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 | ||
38 | static 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 | ||
55 | static 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 | ||
64 | static 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 | ||
73 | static u32 calculate_input_freq(struct platform_device *pdev) | |
74 | { | |
75 | return HCLK_MHZ; | |
76 | } | |
77 | ||
78 | ||
79 | static struct i2c_pnx_algo_data pnx_algo_data0 = { | |
80 | .base = PNX4008_I2C1_BASE, | |
81 | .irq = I2C_1_INT, | |
82 | }; | |
83 | ||
84 | static struct i2c_pnx_algo_data pnx_algo_data1 = { | |
85 | .base = PNX4008_I2C2_BASE, | |
86 | .irq = I2C_2_INT, | |
87 | }; | |
88 | ||
89 | static struct i2c_pnx_algo_data pnx_algo_data2 = { | |
90 | .base = (PNX4008_USB_CONFIG_BASE + 0x300), | |
91 | .irq = USB_I2C_INT, | |
92 | }; | |
93 | ||
94 | static struct i2c_adapter pnx_adapter0 = { | |
95 | .name = I2C_CHIP_NAME "0", | |
96 | .algo_data = &pnx_algo_data0, | |
97 | }; | |
98 | static struct i2c_adapter pnx_adapter1 = { | |
99 | .name = I2C_CHIP_NAME "1", | |
100 | .algo_data = &pnx_algo_data1, | |
101 | }; | |
102 | ||
103 | static struct i2c_adapter pnx_adapter2 = { | |
104 | .name = "USB-I2C", | |
105 | .algo_data = &pnx_algo_data2, | |
106 | }; | |
107 | ||
108 | static 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 | ||
117 | static 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 | ||
126 | static 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 | ||
135 | static struct platform_device i2c0_device = { | |
136 | .name = "pnx-i2c", | |
137 | .id = 0, | |
138 | .dev = { | |
139 | .platform_data = &i2c0_data, | |
140 | }, | |
141 | }; | |
142 | ||
143 | static struct platform_device i2c1_device = { | |
144 | .name = "pnx-i2c", | |
145 | .id = 1, | |
146 | .dev = { | |
147 | .platform_data = &i2c1_data, | |
148 | }, | |
149 | }; | |
150 | ||
151 | static struct platform_device i2c2_device = { | |
152 | .name = "pnx-i2c", | |
153 | .id = 2, | |
154 | .dev = { | |
155 | .platform_data = &i2c2_data, | |
156 | }, | |
157 | }; | |
158 | ||
159 | static struct platform_device *devices[] __initdata = { | |
160 | &i2c0_device, | |
161 | &i2c1_device, | |
162 | &i2c2_device, | |
163 | }; | |
164 | ||
165 | void __init pnx4008_register_i2c_devices(void) | |
166 | { | |
167 | platform_add_devices(devices, ARRAY_SIZE(devices)); | |
168 | } |