1 /* 2 * Copyright (C) 2007-2010 ST-Ericsson 3 * License terms: GNU General Public License (GPL) version 2 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 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 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 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 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 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 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 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 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 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 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