1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) 2007-2010 ST-Ericsson
4 * Register access functions for the ABX500 Mixed Signal IC family.
5 * Author: Mattias Wallin <mattias.wallin@stericsson.com>
6 */
7
8 #include <linux/list.h>
9 #include <linux/slab.h>
10 #include <linux/err.h>
11 #include <linux/init.h>
12 #include <linux/export.h>
13 #include <linux/mfd/abx500.h>
14
15 static LIST_HEAD(abx500_list);
16
17 struct abx500_device_entry {
18 struct list_head list;
19 struct abx500_ops ops;
20 struct device *dev;
21 };
22
lookup_ops(struct device * dev,struct abx500_ops ** ops)23 static void lookup_ops(struct device *dev, struct abx500_ops **ops)
24 {
25 struct abx500_device_entry *dev_entry;
26
27 *ops = NULL;
28 list_for_each_entry(dev_entry, &abx500_list, list) {
29 if (dev_entry->dev == dev) {
30 *ops = &dev_entry->ops;
31 return;
32 }
33 }
34 }
35
abx500_register_ops(struct device * dev,struct abx500_ops * ops)36 int abx500_register_ops(struct device *dev, struct abx500_ops *ops)
37 {
38 struct abx500_device_entry *dev_entry;
39
40 dev_entry = devm_kzalloc(dev, sizeof(*dev_entry), GFP_KERNEL);
41 if (!dev_entry)
42 return -ENOMEM;
43
44 dev_entry->dev = dev;
45 memcpy(&dev_entry->ops, ops, sizeof(*ops));
46
47 list_add_tail(&dev_entry->list, &abx500_list);
48 return 0;
49 }
50 EXPORT_SYMBOL(abx500_register_ops);
51
abx500_remove_ops(struct device * dev)52 void abx500_remove_ops(struct device *dev)
53 {
54 struct abx500_device_entry *dev_entry, *tmp;
55
56 list_for_each_entry_safe(dev_entry, tmp, &abx500_list, list)
57 if (dev_entry->dev == dev)
58 list_del(&dev_entry->list);
59 }
60 EXPORT_SYMBOL(abx500_remove_ops);
61
abx500_set_register_interruptible(struct device * dev,u8 bank,u8 reg,u8 value)62 int abx500_set_register_interruptible(struct device *dev, u8 bank, u8 reg,
63 u8 value)
64 {
65 struct abx500_ops *ops;
66
67 lookup_ops(dev->parent, &ops);
68 if (ops && ops->set_register)
69 return ops->set_register(dev, bank, reg, value);
70 else
71 return -ENOTSUPP;
72 }
73 EXPORT_SYMBOL(abx500_set_register_interruptible);
74
abx500_get_register_interruptible(struct device * dev,u8 bank,u8 reg,u8 * value)75 int abx500_get_register_interruptible(struct device *dev, u8 bank, u8 reg,
76 u8 *value)
77 {
78 struct abx500_ops *ops;
79
80 lookup_ops(dev->parent, &ops);
81 if (ops && ops->get_register)
82 return ops->get_register(dev, bank, reg, value);
83 else
84 return -ENOTSUPP;
85 }
86 EXPORT_SYMBOL(abx500_get_register_interruptible);
87
abx500_get_register_page_interruptible(struct device * dev,u8 bank,u8 first_reg,u8 * regvals,u8 numregs)88 int abx500_get_register_page_interruptible(struct device *dev, u8 bank,
89 u8 first_reg, u8 *regvals, u8 numregs)
90 {
91 struct abx500_ops *ops;
92
93 lookup_ops(dev->parent, &ops);
94 if (ops && ops->get_register_page)
95 return ops->get_register_page(dev, bank,
96 first_reg, regvals, numregs);
97 else
98 return -ENOTSUPP;
99 }
100 EXPORT_SYMBOL(abx500_get_register_page_interruptible);
101
abx500_mask_and_set_register_interruptible(struct device * dev,u8 bank,u8 reg,u8 bitmask,u8 bitvalues)102 int abx500_mask_and_set_register_interruptible(struct device *dev, u8 bank,
103 u8 reg, u8 bitmask, u8 bitvalues)
104 {
105 struct abx500_ops *ops;
106
107 lookup_ops(dev->parent, &ops);
108 if (ops && ops->mask_and_set_register)
109 return ops->mask_and_set_register(dev, bank,
110 reg, bitmask, bitvalues);
111 else
112 return -ENOTSUPP;
113 }
114 EXPORT_SYMBOL(abx500_mask_and_set_register_interruptible);
115
abx500_get_chip_id(struct device * dev)116 int abx500_get_chip_id(struct device *dev)
117 {
118 struct abx500_ops *ops;
119
120 lookup_ops(dev->parent, &ops);
121 if (ops && ops->get_chip_id)
122 return ops->get_chip_id(dev);
123 else
124 return -ENOTSUPP;
125 }
126 EXPORT_SYMBOL(abx500_get_chip_id);
127
abx500_event_registers_startup_state_get(struct device * dev,u8 * event)128 int abx500_event_registers_startup_state_get(struct device *dev, u8 *event)
129 {
130 struct abx500_ops *ops;
131
132 lookup_ops(dev->parent, &ops);
133 if (ops && ops->event_registers_startup_state_get)
134 return ops->event_registers_startup_state_get(dev, event);
135 else
136 return -ENOTSUPP;
137 }
138 EXPORT_SYMBOL(abx500_event_registers_startup_state_get);
139
abx500_startup_irq_enabled(struct device * dev,unsigned int irq)140 int abx500_startup_irq_enabled(struct device *dev, unsigned int irq)
141 {
142 struct abx500_ops *ops;
143
144 lookup_ops(dev->parent, &ops);
145 if (ops && ops->startup_irq_enabled)
146 return ops->startup_irq_enabled(dev, irq);
147 else
148 return -ENOTSUPP;
149 }
150 EXPORT_SYMBOL(abx500_startup_irq_enabled);
151