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