Lines Matching full:d
79 struct regmap_irq_chip_data *d = irq_data_get_irq_chip_data(data); in regmap_irq_lock() local
81 mutex_lock(&d->lock); in regmap_irq_lock()
84 static int regmap_irq_update_bits(struct regmap_irq_chip_data *d, in regmap_irq_update_bits() argument
88 if (d->chip->mask_writeonly) in regmap_irq_update_bits()
89 return regmap_write_bits(d->map, reg, mask, val); in regmap_irq_update_bits()
91 return regmap_update_bits(d->map, reg, mask, val); in regmap_irq_update_bits()
96 struct regmap_irq_chip_data *d = irq_data_get_irq_chip_data(data); in regmap_irq_sync_unlock() local
97 struct regmap *map = d->map; in regmap_irq_sync_unlock()
103 if (d->chip->runtime_pm) { in regmap_irq_sync_unlock()
106 dev_err(map->dev, "IRQ sync failed to resume: %d\n", in regmap_irq_sync_unlock()
110 if (d->clear_status) { in regmap_irq_sync_unlock()
111 for (i = 0; i < d->chip->num_regs; i++) { in regmap_irq_sync_unlock()
112 reg = sub_irq_reg(d, d->chip->status_base, i); in regmap_irq_sync_unlock()
116 dev_err(d->map->dev, in regmap_irq_sync_unlock()
120 d->clear_status = false; in regmap_irq_sync_unlock()
128 for (i = 0; i < d->chip->num_regs; i++) { in regmap_irq_sync_unlock()
129 if (!d->chip->mask_base) in regmap_irq_sync_unlock()
132 reg = sub_irq_reg(d, d->chip->mask_base, i); in regmap_irq_sync_unlock()
133 if (d->chip->mask_invert) { in regmap_irq_sync_unlock()
134 ret = regmap_irq_update_bits(d, reg, in regmap_irq_sync_unlock()
135 d->mask_buf_def[i], ~d->mask_buf[i]); in regmap_irq_sync_unlock()
136 } else if (d->chip->unmask_base) { in regmap_irq_sync_unlock()
138 ret = regmap_irq_update_bits(d, reg, in regmap_irq_sync_unlock()
139 d->mask_buf_def[i], ~d->mask_buf[i]); in regmap_irq_sync_unlock()
141 dev_err(d->map->dev, in regmap_irq_sync_unlock()
144 unmask_offset = d->chip->unmask_base - in regmap_irq_sync_unlock()
145 d->chip->mask_base; in regmap_irq_sync_unlock()
147 ret = regmap_irq_update_bits(d, in regmap_irq_sync_unlock()
149 d->mask_buf_def[i], in regmap_irq_sync_unlock()
150 d->mask_buf[i]); in regmap_irq_sync_unlock()
152 ret = regmap_irq_update_bits(d, reg, in regmap_irq_sync_unlock()
153 d->mask_buf_def[i], d->mask_buf[i]); in regmap_irq_sync_unlock()
156 dev_err(d->map->dev, "Failed to sync masks in %x\n", in regmap_irq_sync_unlock()
159 reg = sub_irq_reg(d, d->chip->wake_base, i); in regmap_irq_sync_unlock()
160 if (d->wake_buf) { in regmap_irq_sync_unlock()
161 if (d->chip->wake_invert) in regmap_irq_sync_unlock()
162 ret = regmap_irq_update_bits(d, reg, in regmap_irq_sync_unlock()
163 d->mask_buf_def[i], in regmap_irq_sync_unlock()
164 ~d->wake_buf[i]); in regmap_irq_sync_unlock()
166 ret = regmap_irq_update_bits(d, reg, in regmap_irq_sync_unlock()
167 d->mask_buf_def[i], in regmap_irq_sync_unlock()
168 d->wake_buf[i]); in regmap_irq_sync_unlock()
170 dev_err(d->map->dev, in regmap_irq_sync_unlock()
171 "Failed to sync wakes in %x: %d\n", in regmap_irq_sync_unlock()
175 if (!d->chip->init_ack_masked) in regmap_irq_sync_unlock()
182 if (d->mask_buf[i] && (d->chip->ack_base || d->chip->use_ack)) { in regmap_irq_sync_unlock()
183 reg = sub_irq_reg(d, d->chip->ack_base, i); in regmap_irq_sync_unlock()
186 if (d->chip->ack_invert) in regmap_irq_sync_unlock()
187 ret = regmap_write(map, reg, ~d->mask_buf[i]); in regmap_irq_sync_unlock()
189 ret = regmap_write(map, reg, d->mask_buf[i]); in regmap_irq_sync_unlock()
190 if (d->chip->clear_ack) { in regmap_irq_sync_unlock()
191 if (d->chip->ack_invert && !ret) in regmap_irq_sync_unlock()
193 d->mask_buf[i]); in regmap_irq_sync_unlock()
196 ~d->mask_buf[i]); in regmap_irq_sync_unlock()
199 dev_err(d->map->dev, "Failed to ack 0x%x: %d\n", in regmap_irq_sync_unlock()
205 if (!d->chip->type_in_mask) { in regmap_irq_sync_unlock()
206 for (i = 0; i < d->chip->num_type_reg; i++) { in regmap_irq_sync_unlock()
207 if (!d->type_buf_def[i]) in regmap_irq_sync_unlock()
209 reg = sub_irq_reg(d, d->chip->type_base, i); in regmap_irq_sync_unlock()
210 if (d->chip->type_invert) in regmap_irq_sync_unlock()
211 ret = regmap_irq_update_bits(d, reg, in regmap_irq_sync_unlock()
212 d->type_buf_def[i], ~d->type_buf[i]); in regmap_irq_sync_unlock()
214 ret = regmap_irq_update_bits(d, reg, in regmap_irq_sync_unlock()
215 d->type_buf_def[i], d->type_buf[i]); in regmap_irq_sync_unlock()
217 dev_err(d->map->dev, "Failed to sync type in %x\n", in regmap_irq_sync_unlock()
222 if (d->chip->num_virt_regs) { in regmap_irq_sync_unlock()
223 for (i = 0; i < d->chip->num_virt_regs; i++) { in regmap_irq_sync_unlock()
224 for (j = 0; j < d->chip->num_regs; j++) { in regmap_irq_sync_unlock()
225 reg = sub_irq_reg(d, d->chip->virt_reg_base[i], in regmap_irq_sync_unlock()
227 ret = regmap_write(map, reg, d->virt_buf[i][j]); in regmap_irq_sync_unlock()
229 dev_err(d->map->dev, in regmap_irq_sync_unlock()
230 "Failed to write virt 0x%x: %d\n", in regmap_irq_sync_unlock()
236 if (d->chip->runtime_pm) in regmap_irq_sync_unlock()
240 if (d->wake_count < 0) in regmap_irq_sync_unlock()
241 for (i = d->wake_count; i < 0; i++) in regmap_irq_sync_unlock()
242 irq_set_irq_wake(d->irq, 0); in regmap_irq_sync_unlock()
243 else if (d->wake_count > 0) in regmap_irq_sync_unlock()
244 for (i = 0; i < d->wake_count; i++) in regmap_irq_sync_unlock()
245 irq_set_irq_wake(d->irq, 1); in regmap_irq_sync_unlock()
247 d->wake_count = 0; in regmap_irq_sync_unlock()
249 mutex_unlock(&d->lock); in regmap_irq_sync_unlock()
254 struct regmap_irq_chip_data *d = irq_data_get_irq_chip_data(data); in regmap_irq_enable() local
255 struct regmap *map = d->map; in regmap_irq_enable()
256 const struct regmap_irq *irq_data = irq_to_regmap_irq(d, data->hwirq); in regmap_irq_enable()
272 if (d->chip->type_in_mask && type) in regmap_irq_enable()
273 mask = d->type_buf[irq_data->reg_offset / map->reg_stride]; in regmap_irq_enable()
277 if (d->chip->clear_on_unmask) in regmap_irq_enable()
278 d->clear_status = true; in regmap_irq_enable()
280 d->mask_buf[irq_data->reg_offset / map->reg_stride] &= ~mask; in regmap_irq_enable()
285 struct regmap_irq_chip_data *d = irq_data_get_irq_chip_data(data); in regmap_irq_disable() local
286 struct regmap *map = d->map; in regmap_irq_disable()
287 const struct regmap_irq *irq_data = irq_to_regmap_irq(d, data->hwirq); in regmap_irq_disable()
289 d->mask_buf[irq_data->reg_offset / map->reg_stride] |= irq_data->mask; in regmap_irq_disable()
294 struct regmap_irq_chip_data *d = irq_data_get_irq_chip_data(data); in regmap_irq_set_type() local
295 struct regmap *map = d->map; in regmap_irq_set_type()
296 const struct regmap_irq *irq_data = irq_to_regmap_irq(d, data->hwirq); in regmap_irq_set_type()
306 d->type_buf[reg] &= ~t->type_reg_mask; in regmap_irq_set_type()
308 d->type_buf[reg] &= ~(t->type_falling_val | in regmap_irq_set_type()
314 d->type_buf[reg] |= t->type_falling_val; in regmap_irq_set_type()
318 d->type_buf[reg] |= t->type_rising_val; in regmap_irq_set_type()
322 d->type_buf[reg] |= (t->type_falling_val | in regmap_irq_set_type()
327 d->type_buf[reg] |= t->type_level_high_val; in regmap_irq_set_type()
331 d->type_buf[reg] |= t->type_level_low_val; in regmap_irq_set_type()
337 if (d->chip->set_type_virt) in regmap_irq_set_type()
338 return d->chip->set_type_virt(d->virt_buf, type, data->hwirq, in regmap_irq_set_type()
346 struct regmap_irq_chip_data *d = irq_data_get_irq_chip_data(data); in regmap_irq_set_wake() local
347 struct regmap *map = d->map; in regmap_irq_set_wake()
348 const struct regmap_irq *irq_data = irq_to_regmap_irq(d, data->hwirq); in regmap_irq_set_wake()
351 if (d->wake_buf) in regmap_irq_set_wake()
352 d->wake_buf[irq_data->reg_offset / map->reg_stride] in regmap_irq_set_wake()
354 d->wake_count++; in regmap_irq_set_wake()
356 if (d->wake_buf) in regmap_irq_set_wake()
357 d->wake_buf[irq_data->reg_offset / map->reg_stride] in regmap_irq_set_wake()
359 d->wake_count--; in regmap_irq_set_wake()
408 static irqreturn_t regmap_irq_thread(int irq, void *d) in regmap_irq_thread() argument
410 struct regmap_irq_chip_data *data = d; in regmap_irq_thread()
423 dev_err(map->dev, "IRQ thread failed to resume: %d\n", in regmap_irq_thread()
458 "Failed to read IRQ status %d\n", in regmap_irq_thread()
477 "Failed to read IRQ status %d\n", in regmap_irq_thread()
497 dev_err(map->dev, "Failed to read IRQ status: %d\n", in regmap_irq_thread()
527 "Failed to read IRQ status: %d\n", in regmap_irq_thread()
566 dev_err(map->dev, "Failed to ack 0x%x: %d\n", in regmap_irq_thread()
634 struct regmap_irq_chip_data *d; in regmap_add_irq_chip_fwnode() local
664 dev_warn(map->dev, "Failed to allocate IRQs: %d\n", in regmap_add_irq_chip_fwnode()
670 d = kzalloc(sizeof(*d), GFP_KERNEL); in regmap_add_irq_chip_fwnode()
671 if (!d) in regmap_add_irq_chip_fwnode()
675 d->main_status_buf = kcalloc(chip->num_main_regs, in regmap_add_irq_chip_fwnode()
679 if (!d->main_status_buf) in regmap_add_irq_chip_fwnode()
683 d->status_buf = kcalloc(chip->num_regs, sizeof(unsigned int), in regmap_add_irq_chip_fwnode()
685 if (!d->status_buf) in regmap_add_irq_chip_fwnode()
688 d->mask_buf = kcalloc(chip->num_regs, sizeof(unsigned int), in regmap_add_irq_chip_fwnode()
690 if (!d->mask_buf) in regmap_add_irq_chip_fwnode()
693 d->mask_buf_def = kcalloc(chip->num_regs, sizeof(unsigned int), in regmap_add_irq_chip_fwnode()
695 if (!d->mask_buf_def) in regmap_add_irq_chip_fwnode()
699 d->wake_buf = kcalloc(chip->num_regs, sizeof(unsigned int), in regmap_add_irq_chip_fwnode()
701 if (!d->wake_buf) in regmap_add_irq_chip_fwnode()
707 d->type_buf_def = kcalloc(num_type_reg, in regmap_add_irq_chip_fwnode()
709 if (!d->type_buf_def) in regmap_add_irq_chip_fwnode()
712 d->type_buf = kcalloc(num_type_reg, sizeof(unsigned int), in regmap_add_irq_chip_fwnode()
714 if (!d->type_buf) in regmap_add_irq_chip_fwnode()
722 d->virt_buf = kcalloc(chip->num_virt_regs, sizeof(*d->virt_buf), in regmap_add_irq_chip_fwnode()
724 if (!d->virt_buf) in regmap_add_irq_chip_fwnode()
728 d->virt_buf[i] = kcalloc(chip->num_regs, in regmap_add_irq_chip_fwnode()
731 if (!d->virt_buf[i]) in regmap_add_irq_chip_fwnode()
736 d->irq_chip = regmap_irq_chip; in regmap_add_irq_chip_fwnode()
737 d->irq_chip.name = chip->name; in regmap_add_irq_chip_fwnode()
738 d->irq = irq; in regmap_add_irq_chip_fwnode()
739 d->map = map; in regmap_add_irq_chip_fwnode()
740 d->chip = chip; in regmap_add_irq_chip_fwnode()
741 d->irq_base = irq_base; in regmap_add_irq_chip_fwnode()
744 d->irq_reg_stride = chip->irq_reg_stride; in regmap_add_irq_chip_fwnode()
746 d->irq_reg_stride = 1; in regmap_add_irq_chip_fwnode()
749 d->type_reg_stride = chip->type_reg_stride; in regmap_add_irq_chip_fwnode()
751 d->type_reg_stride = 1; in regmap_add_irq_chip_fwnode()
754 d->irq_reg_stride == 1) { in regmap_add_irq_chip_fwnode()
755 d->status_reg_buf = kmalloc_array(chip->num_regs, in regmap_add_irq_chip_fwnode()
758 if (!d->status_reg_buf) in regmap_add_irq_chip_fwnode()
762 mutex_init(&d->lock); in regmap_add_irq_chip_fwnode()
765 d->mask_buf_def[chip->irqs[i].reg_offset / map->reg_stride] in regmap_add_irq_chip_fwnode()
770 d->mask_buf[i] = d->mask_buf_def[i]; in regmap_add_irq_chip_fwnode()
774 reg = sub_irq_reg(d, d->chip->mask_base, i); in regmap_add_irq_chip_fwnode()
777 ret = regmap_irq_update_bits(d, reg, in regmap_add_irq_chip_fwnode()
778 d->mask_buf[i], ~d->mask_buf[i]); in regmap_add_irq_chip_fwnode()
779 else if (d->chip->unmask_base) { in regmap_add_irq_chip_fwnode()
780 unmask_offset = d->chip->unmask_base - in regmap_add_irq_chip_fwnode()
781 d->chip->mask_base; in regmap_add_irq_chip_fwnode()
782 ret = regmap_irq_update_bits(d, in regmap_add_irq_chip_fwnode()
784 d->mask_buf[i], in regmap_add_irq_chip_fwnode()
785 d->mask_buf[i]); in regmap_add_irq_chip_fwnode()
787 ret = regmap_irq_update_bits(d, reg, in regmap_add_irq_chip_fwnode()
788 d->mask_buf[i], d->mask_buf[i]); in regmap_add_irq_chip_fwnode()
790 dev_err(map->dev, "Failed to set masks in 0x%x: %d\n", in regmap_add_irq_chip_fwnode()
799 reg = sub_irq_reg(d, d->chip->status_base, i); in regmap_add_irq_chip_fwnode()
800 ret = regmap_read(map, reg, &d->status_buf[i]); in regmap_add_irq_chip_fwnode()
802 dev_err(map->dev, "Failed to read IRQ status: %d\n", in regmap_add_irq_chip_fwnode()
808 d->status_buf[i] = ~d->status_buf[i]; in regmap_add_irq_chip_fwnode()
810 if (d->status_buf[i] && (chip->ack_base || chip->use_ack)) { in regmap_add_irq_chip_fwnode()
811 reg = sub_irq_reg(d, d->chip->ack_base, i); in regmap_add_irq_chip_fwnode()
814 ~(d->status_buf[i] & d->mask_buf[i])); in regmap_add_irq_chip_fwnode()
817 d->status_buf[i] & d->mask_buf[i]); in regmap_add_irq_chip_fwnode()
821 (d->status_buf[i] & in regmap_add_irq_chip_fwnode()
822 d->mask_buf[i])); in regmap_add_irq_chip_fwnode()
825 ~(d->status_buf[i] & in regmap_add_irq_chip_fwnode()
826 d->mask_buf[i])); in regmap_add_irq_chip_fwnode()
829 dev_err(map->dev, "Failed to ack 0x%x: %d\n", in regmap_add_irq_chip_fwnode()
837 if (d->wake_buf) { in regmap_add_irq_chip_fwnode()
839 d->wake_buf[i] = d->mask_buf_def[i]; in regmap_add_irq_chip_fwnode()
840 reg = sub_irq_reg(d, d->chip->wake_base, i); in regmap_add_irq_chip_fwnode()
843 ret = regmap_irq_update_bits(d, reg, in regmap_add_irq_chip_fwnode()
844 d->mask_buf_def[i], in regmap_add_irq_chip_fwnode()
847 ret = regmap_irq_update_bits(d, reg, in regmap_add_irq_chip_fwnode()
848 d->mask_buf_def[i], in regmap_add_irq_chip_fwnode()
849 d->wake_buf[i]); in regmap_add_irq_chip_fwnode()
851 dev_err(map->dev, "Failed to set masks in 0x%x: %d\n", in regmap_add_irq_chip_fwnode()
860 reg = sub_irq_reg(d, d->chip->type_base, i); in regmap_add_irq_chip_fwnode()
862 ret = regmap_read(map, reg, &d->type_buf_def[i]); in regmap_add_irq_chip_fwnode()
864 if (d->chip->type_invert) in regmap_add_irq_chip_fwnode()
865 d->type_buf_def[i] = ~d->type_buf_def[i]; in regmap_add_irq_chip_fwnode()
868 dev_err(map->dev, "Failed to get type defaults at 0x%x: %d\n", in regmap_add_irq_chip_fwnode()
876 d->domain = irq_domain_create_legacy(fwnode, chip->num_irqs, in regmap_add_irq_chip_fwnode()
878 ®map_domain_ops, d); in regmap_add_irq_chip_fwnode()
880 d->domain = irq_domain_create_linear(fwnode, chip->num_irqs, in regmap_add_irq_chip_fwnode()
881 ®map_domain_ops, d); in regmap_add_irq_chip_fwnode()
882 if (!d->domain) { in regmap_add_irq_chip_fwnode()
890 chip->name, d); in regmap_add_irq_chip_fwnode()
892 dev_err(map->dev, "Failed to request IRQ %d for %s: %d\n", in regmap_add_irq_chip_fwnode()
897 *data = d; in regmap_add_irq_chip_fwnode()
904 kfree(d->type_buf); in regmap_add_irq_chip_fwnode()
905 kfree(d->type_buf_def); in regmap_add_irq_chip_fwnode()
906 kfree(d->wake_buf); in regmap_add_irq_chip_fwnode()
907 kfree(d->mask_buf_def); in regmap_add_irq_chip_fwnode()
908 kfree(d->mask_buf); in regmap_add_irq_chip_fwnode()
909 kfree(d->status_buf); in regmap_add_irq_chip_fwnode()
910 kfree(d->status_reg_buf); in regmap_add_irq_chip_fwnode()
911 if (d->virt_buf) { in regmap_add_irq_chip_fwnode()
913 kfree(d->virt_buf[i]); in regmap_add_irq_chip_fwnode()
914 kfree(d->virt_buf); in regmap_add_irq_chip_fwnode()
916 kfree(d); in regmap_add_irq_chip_fwnode()
949 * @d: ®map_irq_chip_data allocated by regmap_add_irq_chip()
953 void regmap_del_irq_chip(int irq, struct regmap_irq_chip_data *d) in regmap_del_irq_chip() argument
958 if (!d) in regmap_del_irq_chip()
961 free_irq(irq, d); in regmap_del_irq_chip()
964 for (hwirq = 0; hwirq < d->chip->num_irqs; hwirq++) { in regmap_del_irq_chip()
966 if (!d->chip->irqs[hwirq].mask) in regmap_del_irq_chip()
973 virq = irq_find_mapping(d->domain, hwirq); in regmap_del_irq_chip()
978 irq_domain_remove(d->domain); in regmap_del_irq_chip()
979 kfree(d->type_buf); in regmap_del_irq_chip()
980 kfree(d->type_buf_def); in regmap_del_irq_chip()
981 kfree(d->wake_buf); in regmap_del_irq_chip()
982 kfree(d->mask_buf_def); in regmap_del_irq_chip()
983 kfree(d->mask_buf); in regmap_del_irq_chip()
984 kfree(d->status_reg_buf); in regmap_del_irq_chip()
985 kfree(d->status_buf); in regmap_del_irq_chip()
986 kfree(d); in regmap_del_irq_chip()
992 struct regmap_irq_chip_data *d = *(struct regmap_irq_chip_data **)res; in devm_regmap_irq_chip_release() local
994 regmap_del_irq_chip(d->irq, d); in devm_regmap_irq_chip_release()
1033 struct regmap_irq_chip_data **ptr, *d; in devm_regmap_add_irq_chip_fwnode() local
1042 chip, &d); in devm_regmap_add_irq_chip_fwnode()
1048 *ptr = d; in devm_regmap_add_irq_chip_fwnode()
1050 *data = d; in devm_regmap_add_irq_chip_fwnode()