i2c/busses/i2c-octeon-platdrv.c

7  * This is a driver for the i2c adapter in Cavium Networks' OCTEON processors.
16 #include <linux/i2c.h>
27 #include "i2c-octeon-core.h"
29 #define DRV_NAME "i2c-octeon"
33  * @i2c: The struct octeon_i2c
38 static void octeon_i2c_int_enable(struct octeon_i2c *i2c)
40 	octeon_i2c_write_int(i2c, TWSI_INT_CORE_EN);
44 static void octeon_i2c_int_disable(struct octeon_i2c *i2c)
47 	octeon_i2c_write_int(i2c, 0);
52  * @i2c: The struct octeon_i2c
57 static void octeon_i2c_int_enable78(struct octeon_i2c *i2c)
59 	atomic_inc_return(&i2c->int_enable_cnt);
60 	enable_irq(i2c->irq);
78 static void octeon_i2c_int_disable78(struct octeon_i2c *i2c)
80 	__octeon_i2c_irq_disable(&i2c->int_enable_cnt, i2c->irq);
85  * @i2c: The struct octeon_i2c
90 static void octeon_i2c_hlc_int_enable78(struct octeon_i2c *i2c)
92 	atomic_inc_return(&i2c->hlc_int_enable_cnt);
93 	enable_irq(i2c->hlc_irq);
97 static void octeon_i2c_hlc_int_disable78(struct octeon_i2c *i2c)
99 	__octeon_i2c_irq_disable(&i2c->hlc_int_enable_cnt, i2c->hlc_irq);
105 	struct octeon_i2c *i2c = dev_id;
107 	i2c->hlc_int_disable(i2c);
108 	wake_up(&i2c->queue);
113 static void octeon_i2c_hlc_int_enable(struct octeon_i2c *i2c)
115 	octeon_i2c_write_int(i2c, TWSI_INT_ST_EN);
139 	struct octeon_i2c *i2c;
158 	i2c = devm_kzalloc(&pdev->dev, sizeof(*i2c), GFP_KERNEL);
159 	if (!i2c) {
163 	i2c->dev = &pdev->dev;
165 	i2c->roff.sw_twsi = 0x00;
166 	i2c->roff.twsi_int = 0x10;
167 	i2c->roff.sw_twsi_ext = 0x18;
169 	i2c->twsi_base = devm_platform_ioremap_resource(pdev, 0);
170 	if (IS_ERR(i2c->twsi_base)) {
171 		result = PTR_ERR(i2c->twsi_base);
180 	if (of_property_read_u32(node, "clock-frequency", &i2c->twsi_freq) &&
181 	    of_property_read_u32(node, "clock-rate", &i2c->twsi_freq)) {
182 		dev_err(i2c->dev,
188 	i2c->sys_freq = octeon_get_io_clock_rate();
190 	init_waitqueue_head(&i2c->queue);
192 	i2c->irq = irq;
195 		i2c->hlc_irq = hlc_irq;
197 		i2c->int_enable = octeon_i2c_int_enable78;
198 		i2c->int_disable = octeon_i2c_int_disable78;
199 		i2c->hlc_int_enable = octeon_i2c_hlc_int_enable78;
200 		i2c->hlc_int_disable = octeon_i2c_hlc_int_disable78;
202 		irq_set_status_flags(i2c->irq, IRQ_NOAUTOEN);
203 		irq_set_status_flags(i2c->hlc_irq, IRQ_NOAUTOEN);
205 		result = devm_request_irq(&pdev->dev, i2c->hlc_irq,
207 					  DRV_NAME, i2c);
209 			dev_err(i2c->dev, "failed to attach interrupt\n");
213 		i2c->int_enable = octeon_i2c_int_enable;
214 		i2c->int_disable = octeon_i2c_int_disable;
215 		i2c->hlc_int_enable = octeon_i2c_hlc_int_enable;
216 		i2c->hlc_int_disable = octeon_i2c_int_disable;
219 	result = devm_request_irq(&pdev->dev, i2c->irq,
220 				  octeon_i2c_isr, 0, DRV_NAME, i2c);
222 		dev_err(i2c->dev, "failed to attach interrupt\n");
227 		i2c->broken_irq_check = true;
229 	result = octeon_i2c_init_lowlevel(i2c);
231 		dev_err(i2c->dev, "init low level failed\n");
235 	octeon_i2c_set_clock(i2c);
237 	i2c->adap = octeon_i2c_ops;
238 	i2c->adap.timeout = msecs_to_jiffies(2);
239 	i2c->adap.retries = 5;
240 	i2c->adap.bus_recovery_info = &octeon_i2c_recovery_info;
241 	i2c->adap.dev.parent = &pdev->dev;
242 	i2c->adap.dev.of_node = node;
243 	i2c_set_adapdata(&i2c->adap, i2c);
244 	platform_set_drvdata(pdev, i2c);
246 	result = i2c_add_adapter(&i2c->adap);
249 	dev_info(i2c->dev, "probed\n");
258 	struct octeon_i2c *i2c = platform_get_drvdata(pdev);
260 	i2c_del_adapter(&i2c->adap);