Commit | Line | Data |
---|---|---|
be2553ff OJ |
1 | /* |
2 | * Copyright (C) 2007 PA Semi, Inc | |
3 | * | |
4 | * Parts based on arch/powerpc/sysdev/fsl_soc.c: | |
5 | * | |
6 | * 2006 (c) MontaVista Software, Inc. | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify it | |
9 | * under the terms of the GNU General Public License as published by the | |
10 | * Free Software Foundation; either version 2 of the License, or (at your | |
11 | * option) any later version. | |
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 | /* The below is from fsl_soc.c. It's copied because since there are no | |
22 | * official bus bindings at this time it doesn't make sense to share across | |
23 | * the platforms, even though they happen to be common. | |
24 | */ | |
25 | struct i2c_driver_device { | |
26 | char *of_device; | |
be2553ff OJ |
27 | char *i2c_type; |
28 | }; | |
29 | ||
30 | static struct i2c_driver_device i2c_devices[] __initdata = { | |
238a871e | 31 | {"dallas,ds1338", "ds1338"}, |
be2553ff OJ |
32 | }; |
33 | ||
34 | static 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; | |
238a871e | 42 | if (strlcpy(info->type, i2c_devices[i].i2c_type, |
be2553ff OJ |
43 | I2C_NAME_SIZE) >= I2C_NAME_SIZE) |
44 | return -ENOMEM; | |
45 | return 0; | |
46 | } | |
47 | return -ENODEV; | |
48 | } | |
49 | ||
50 | static 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); | |
ef24ba70 | 79 | if (!info.irq) |
be2553ff OJ |
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 | } | |
93 | device_initcall(pasemi_register_i2c_devices); | |
94 | #endif |