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