1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/errno.h>
15#include <linux/kernel.h>
16#include <linux/pci.h>
17#include <linux/of.h>
18#include <linux/i2c.h>
19
20#ifdef CONFIG_I2C_BOARDINFO
21
22
23
24
25struct i2c_driver_device {
26 char *of_device;
27 char *i2c_type;
28};
29
30static struct i2c_driver_device i2c_devices[] __initdata = {
31 {"dallas,ds1338", "ds1338"},
32};
33
34static int __init find_i2c_driver(struct device_node *node,
35 struct i2c_board_info *info)
36{
37 int i;
38
39 for (i = 0; i < ARRAY_SIZE(i2c_devices); i++) {
40 if (!of_device_is_compatible(node, i2c_devices[i].of_device))
41 continue;
42 if (strlcpy(info->type, i2c_devices[i].i2c_type,
43 I2C_NAME_SIZE) >= I2C_NAME_SIZE)
44 return -ENOMEM;
45 return 0;
46 }
47 return -ENODEV;
48}
49
50static int __init pasemi_register_i2c_devices(void)
51{
52 struct pci_dev *pdev;
53 struct device_node *adap_node;
54 struct device_node *node;
55
56 pdev = NULL;
57 while ((pdev = pci_get_device(PCI_VENDOR_ID_PASEMI, 0xa003, pdev))) {
58 adap_node = pci_device_to_OF_node(pdev);
59
60 if (!adap_node)
61 continue;
62
63 node = NULL;
64 while ((node = of_get_next_child(adap_node, node))) {
65 struct i2c_board_info info = {};
66 const u32 *addr;
67 int len;
68
69 addr = of_get_property(node, "reg", &len);
70 if (!addr || len < sizeof(int) ||
71 *addr > (1 << 10) - 1) {
72 printk(KERN_WARNING
73 "pasemi_register_i2c_devices: "
74 "invalid i2c device entry\n");
75 continue;
76 }
77
78 info.irq = irq_of_parse_and_map(node, 0);
79 if (info.irq == NO_IRQ)
80 info.irq = -1;
81
82 if (find_i2c_driver(node, &info) < 0)
83 continue;
84
85 info.addr = *addr;
86
87 i2c_register_board_info(PCI_FUNC(pdev->devfn), &info,
88 1);
89 }
90 }
91 return 0;
92}
93device_initcall(pasemi_register_i2c_devices);
94#endif
95