drivers/mfd/ab8500-core.c

21 #include <linux/mfd/abx500/ab8500.h>
129  * defined in linux/mfd/ab8500.h
157 static int ab8500_prcmu_write(struct ab8500 *ab8500, u16 addr, u8 data)
163 		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
167 static int ab8500_prcmu_write_masked(struct ab8500 *ab8500, u16 addr, u8 mask,
175 		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
179 static int ab8500_prcmu_read(struct ab8500 *ab8500, u16 addr)
186 		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
194 	struct ab8500 *ab8500;
198 	ab8500 = dev_get_drvdata(dev->parent);
199 	return ab8500 ? (int)ab8500->chip_id : -EINVAL;
202 static int set_register_interruptible(struct ab8500 *ab8500, u8 bank,
212 	dev_vdbg(ab8500->dev, "wr: addr %#x <= %#x\n", addr, data);
214 	mutex_lock(&ab8500->lock);
216 	ret = ab8500->write(ab8500, addr, data);
218 		dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
220 	mutex_unlock(&ab8500->lock);
229 	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
231 	atomic_inc(&ab8500->transfer_ongoing);
232 	ret = set_register_interruptible(ab8500, bank, reg, value);
233 	atomic_dec(&ab8500->transfer_ongoing);
237 static int get_register_interruptible(struct ab8500 *ab8500, u8 bank,
243 	mutex_lock(&ab8500->lock);
245 	ret = ab8500->read(ab8500, addr);
247 		dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
252 	mutex_unlock(&ab8500->lock);
253 	dev_vdbg(ab8500->dev, "rd: addr %#x => data %#x\n", addr, ret);
262 	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
264 	atomic_inc(&ab8500->transfer_ongoing);
265 	ret = get_register_interruptible(ab8500, bank, reg, value);
266 	atomic_dec(&ab8500->transfer_ongoing);
270 static int mask_and_set_register_interruptible(struct ab8500 *ab8500, u8 bank,
276 	mutex_lock(&ab8500->lock);
278 	if (ab8500->write_masked == NULL) {
281 		ret = ab8500->read(ab8500, addr);
283 			dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
291 		ret = ab8500->write(ab8500, addr, data);
293 			dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
296 		dev_vdbg(ab8500->dev, "mask: addr %#x => data %#x\n", addr,
300 	ret = ab8500->write_masked(ab8500, addr, bitmask, bitvalues);
302 		dev_err(ab8500->dev, "failed to modify reg %#x: %d\n", addr,
305 	mutex_unlock(&ab8500->lock);
313 	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
315 	atomic_inc(&ab8500->transfer_ongoing);
316 	ret = mask_and_set_register_interruptible(ab8500, bank, reg,
318 	atomic_dec(&ab8500->transfer_ongoing);
336 	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
338 	mutex_lock(&ab8500->irq_lock);
339 	atomic_inc(&ab8500->transfer_ongoing);
344 	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
347 	for (i = 0; i < ab8500->mask_size; i++) {
348 		u8 old = ab8500->oldmask[i];
349 		u8 new = ab8500->mask[i];
359 		if (ab8500->irq_reg_offset[i] == 11 &&
360 			is_ab8500_1p1_or_earlier(ab8500))
363 		if (ab8500->irq_reg_offset[i] < 0)
366 		ab8500->oldmask[i] = new;
368 		reg = AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i];
369 		set_register_interruptible(ab8500, AB8500_INTERRUPT, reg, new);
371 	atomic_dec(&ab8500->transfer_ongoing);
372 	mutex_unlock(&ab8500->irq_lock);
377 	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
382 	ab8500->mask[index] |= mask;
386 		ab8500->mask[index + 2] |= mask;
388 		ab8500->mask[index + 1] |= mask;
391 		ab8500->mask[index] |= (mask << 1);
396 	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
403 		ab8500->mask[index] &= ~mask;
408 			ab8500->mask[index + 2] &= ~mask;
411 			ab8500->mask[index + 1] &= ~mask;
415 			ab8500->mask[index] &= ~(mask << 1);
417 			ab8500->mask[index] &= ~mask;
420 		ab8500->mask[index] &= ~mask;
430 	.name			= "ab8500",
451 static int ab8500_handle_hierarchical_line(struct ab8500 *ab8500,
456 	for (i = 0; i < ab8500->mask_size; i++)
457 		if (ab8500->irq_reg_offset[i] == latch_offset)
460 	if (i >= ab8500->mask_size) {
461 		dev_err(ab8500->dev, "Register offset 0x%2x not declared\n",
467 	latch_val &= ~ab8500->mask[i];
487 		handle_nested_irq(irq_find_mapping(ab8500->domain, line));
493 static int ab8500_handle_hierarchical_latch(struct ab8500 *ab8500,
505 		status = get_register_interruptible(ab8500,
512 		status = ab8500_handle_hierarchical_line(ab8500,
525 	struct ab8500 *ab8500 = dev;
528 	dev_vdbg(ab8500->dev, "interrupt\n");
531 	for (i = 0; i < (ab8500->it_latchhier_num); i++) {
535 		status = get_register_interruptible(ab8500, AB8500_INTERRUPT,
540 		status = ab8500_handle_hierarchical_latch(ab8500, i, hier_val);
550 	struct ab8500 *ab8500 = d->host_data;
552 	if (!ab8500)
555 	irq_set_chip_data(virq, ab8500);
569 static int ab8500_irq_init(struct ab8500 *ab8500, struct device_node *np)
573 	if (is_ab8540(ab8500))
575 	else if (is_ab9540(ab8500))
577 	else if (is_ab8505(ab8500))
583 	ab8500->domain = irq_domain_add_simple(ab8500->dev->of_node,
585 					       &ab8500_irq_ops, ab8500);
587 	if (!ab8500->domain) {
588 		dev_err(ab8500->dev, "Failed to create irqdomain\n");
595 int ab8500_suspend(struct ab8500 *ab8500)
597 	if (atomic_read(&ab8500->transfer_ongoing))
604 	MFD_CELL_OF("ab8500-charger", NULL, NULL, 0, 0,
605 		    "stericsson,ab8500-charger"),
606 	MFD_CELL_OF("ab8500-btemp", NULL, NULL, 0, 0,
607 		    "stericsson,ab8500-btemp"),
608 	MFD_CELL_OF("ab8500-fg", NULL, NULL, 0, 0,
609 		    "stericsson,ab8500-fg"),
610 	MFD_CELL_OF("ab8500-chargalg", NULL, NULL, 0, 0,
611 		    "stericsson,ab8500-chargalg"),
615 	MFD_CELL_OF("ab8500-sysctrl",
616 		    NULL, NULL, 0, 0, "stericsson,ab8500-sysctrl"),
617 	MFD_CELL_OF("ab8500-ext-regulator",
618 		    NULL, NULL, 0, 0, "stericsson,ab8500-ext-regulator"),
619 	MFD_CELL_OF("ab8500-regulator",
620 		    NULL, NULL, 0, 0, "stericsson,ab8500-regulator"),
621 	MFD_CELL_OF("ab8500-clk",
622 		    NULL, NULL, 0, 0, "stericsson,ab8500-clk"),
623 	MFD_CELL_OF("ab8500-gpadc",
624 		    NULL, NULL, 0, 0, "stericsson,ab8500-gpadc"),
625 	MFD_CELL_OF("ab8500-rtc",
626 		    NULL, NULL, 0, 0, "stericsson,ab8500-rtc"),
627 	MFD_CELL_OF("ab8500-acc-det",
628 		    NULL, NULL, 0, 0, "stericsson,ab8500-acc-det"),
629 	MFD_CELL_OF("ab8500-poweron-key",
630 		    NULL, NULL, 0, 0, "stericsson,ab8500-poweron-key"),
631 	MFD_CELL_OF("ab8500-pwm",
632 		    NULL, NULL, 0, 1, "stericsson,ab8500-pwm"),
633 	MFD_CELL_OF("ab8500-pwm",
634 		    NULL, NULL, 0, 2, "stericsson,ab8500-pwm"),
635 	MFD_CELL_OF("ab8500-pwm",
636 		    NULL, NULL, 0, 3, "stericsson,ab8500-pwm"),
637 	MFD_CELL_OF("ab8500-denc",
638 		    NULL, NULL, 0, 0, "stericsson,ab8500-denc"),
639 	MFD_CELL_OF("pinctrl-ab8500",
640 		    NULL, NULL, 0, 0, "stericsson,ab8500-gpio"),
643 	MFD_CELL_OF("ab8500-usb",
644 		    NULL, NULL, 0, 0, "stericsson,ab8500-usb"),
645 	MFD_CELL_OF("ab8500-codec",
646 		    NULL, NULL, 0, 0, "stericsson,ab8500-codec"),
651 		.name = "ab8500-sysctrl",
654 		.name = "ab8500-ext-regulator",
657 		.name = "ab8500-regulator",
664 		.name = "ab8500-gpadc",
665 		.of_compatible = "stericsson,ab8500-gpadc",
668 		.name = "ab8500-rtc",
671 		.name = "ab8500-acc-det",
674 		.name = "ab8500-poweron-key",
677 		.name = "ab8500-pwm",
701 		.name = "ab8500-sysctrl",
702 		.of_compatible = "stericsson,ab8500-sysctrl",
705 		.name = "ab8500-regulator",
710 		.of_compatible = "stericsson,ab8500-clk",
713 		.name = "ab8500-gpadc",
714 		.of_compatible = "stericsson,ab8500-gpadc",
717 		.name = "ab8500-rtc",
718 		.of_compatible = "stericsson,ab8500-rtc",
721 		.name = "ab8500-acc-det",
722 		.of_compatible = "stericsson,ab8500-acc-det",
725 		.name = "ab8500-poweron-key",
726 		.of_compatible = "stericsson,ab8500-poweron-key",
729 		.name = "ab8500-pwm",
730 		.of_compatible = "stericsson,ab8500-pwm",
738 		.name = "ab8500-usb",
739 		.of_compatible = "stericsson,ab8500-usb",
742 		.name = "ab8500-codec",
743 		.of_compatible = "stericsson,ab8500-codec",
752 		.name = "ab8500-sysctrl",
755 		.name = "ab8500-ext-regulator",
758 		.name = "ab8500-regulator",
765 		.name = "ab8500-gpadc",
766 		.of_compatible = "stericsson,ab8500-gpadc",
769 		.name = "ab8500-acc-det",
772 		.name = "ab8500-poweron-key",
775 		.name = "ab8500-pwm",
797 		.name = "ab8500-rtc",
798 		.of_compatible = "stericsson,ab8500-rtc",
812 	struct ab8500 *ab8500;
814 	ab8500 = dev_get_drvdata(dev);
816 	return sprintf(buf, "%#x\n", ab8500 ? ab8500->chip_id : -EINVAL);
820  * ab8500 has switched off due to (SWITCH_OFF_STATUS):
835 	struct ab8500 *ab8500;
837 	ab8500 = dev_get_drvdata(dev);
838 	ret = get_register_interruptible(ab8500, AB8500_RTC,
855  * ab8500 has turned on due to (TURN_ON_STATUS):
870 	struct ab8500 *ab8500;
872 	ab8500 = dev_get_drvdata(dev);
873 	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
885 	if (is_ab9540(ab8500)) {
899 	struct ab8500 *ab8500;
901 	ab8500 = dev_get_drvdata(dev);
902 	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
912 	struct ab8500 *ab8500;
916 	ab8500 = dev_get_drvdata(dev);
918 	ret = get_register_interruptible(ab8500, AB8500_REGU_CTRL2,
930 	struct ab8500 *ab8500;
935 	ab8500 = dev_get_drvdata(dev);
949 		err = mask_and_set_register_interruptible(ab8500,
953 			dev_info(ab8500->dev,
1023 	struct ab8500 *ab8500;
1029 	ab8500 = devm_kzalloc(&pdev->dev, sizeof(*ab8500), GFP_KERNEL);
1030 	if (!ab8500)
1033 	ab8500->dev = &pdev->dev;
1039 	ab8500->irq = irq;
1041 	ab8500->read = ab8500_prcmu_read;
1042 	ab8500->write = ab8500_prcmu_write;
1043 	ab8500->write_masked = ab8500_prcmu_write_masked;
1045 	mutex_init(&ab8500->lock);
1046 	mutex_init(&ab8500->irq_lock);
1047 	atomic_set(&ab8500->transfer_ongoing, 0);
1049 	platform_set_drvdata(pdev, ab8500);
1055 		ab8500->version = version;
1057 		ret = get_register_interruptible(ab8500, AB8500_MISC,
1064 		ab8500->version = value;
1067 	ret = get_register_interruptible(ab8500, AB8500_MISC,
1072 	ab8500->chip_id = value;
1074 	dev_info(ab8500->dev, "detected chip, %s rev. %1x.%1x\n",
1075 			ab8500_version_str[ab8500->version],
1076 			ab8500->chip_id >> 4,
1077 			ab8500->chip_id & 0x0F);
1080 	if (is_ab8540(ab8500)) {
1081 		ab8500->mask_size = AB8540_NUM_IRQ_REGS;
1082 		ab8500->irq_reg_offset = ab8540_irq_regoffset;
1083 		ab8500->it_latchhier_num = AB8540_IT_LATCHHIER_NUM;
1085 	else if (is_ab9540(ab8500) || is_ab8505(ab8500)) {
1086 		ab8500->mask_size = AB9540_NUM_IRQ_REGS;
1087 		ab8500->irq_reg_offset = ab9540_irq_regoffset;
1088 		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1090 		ab8500->mask_size = AB8500_NUM_IRQ_REGS;
1091 		ab8500->irq_reg_offset = ab8500_irq_regoffset;
1092 		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1094 	ab8500->mask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1096 	if (!ab8500->mask)
1098 	ab8500->oldmask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1100 	if (!ab8500->oldmask)
1104 	 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
1115 	ret = get_register_interruptible(ab8500, AB8500_RTC,
1119 	dev_info(ab8500->dev, "switch off cause(s) (%#x): ", value);
1132 	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
1136 	dev_info(ab8500->dev, "turn on reason(s) (%#x): ", value);
1149 	if (is_ab9540(ab8500)) {
1150 		ret = get_register_interruptible(ab8500, AB8500_CHARGER,
1160 	for (i = 0; i < ab8500->mask_size; i++) {
1165 		if (ab8500->irq_reg_offset[i] == 11 &&
1166 				is_ab8500_1p1_or_earlier(ab8500))
1169 		if (ab8500->irq_reg_offset[i] < 0)
1172 		get_register_interruptible(ab8500, AB8500_INTERRUPT,
1173 			AB8500_IT_LATCH1_REG + ab8500->irq_reg_offset[i],
1175 		set_register_interruptible(ab8500, AB8500_INTERRUPT,
1176 			AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i], 0xff);
1179 	ret = abx500_register_ops(ab8500->dev, &ab8500_ops);
1183 	for (i = 0; i < ab8500->mask_size; i++)
1184 		ab8500->mask[i] = ab8500->oldmask[i] = 0xff;
1186 	ret = ab8500_irq_init(ab8500, np);
1190 	ret = devm_request_threaded_irq(&pdev->dev, ab8500->irq, NULL,
1193 			"ab8500", ab8500);
1197 	if (is_ab9540(ab8500))
1198 		ret = mfd_add_devices(ab8500->dev, 0, ab9540_devs,
1200 				0, ab8500->domain);
1201 	else if (is_ab8540(ab8500)) {
1202 		ret = mfd_add_devices(ab8500->dev, 0, ab8540_devs,
1204 			      0, ab8500->domain);
1208 		if (is_ab8540_1p2_or_earlier(ab8500))
1209 			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut1_devs,
1211 			      0, ab8500->domain);
1213 			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut2_devs,
1215 			      0, ab8500->domain);
1216 	} else if (is_ab8505(ab8500))
1217 		ret = mfd_add_devices(ab8500->dev, 0, ab8505_devs,
1219 			      0, ab8500->domain);
1221 		ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs,
1223 				0, ab8500->domain);
1228 	ret = mfd_add_devices(ab8500->dev, 0, ab8500_bm_devs,
1230 			      0, ab8500->domain);
1232 		dev_err(ab8500->dev, "error adding bm devices\n");
1234 	if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1235 			ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
1236 		ret = sysfs_create_group(&ab8500->dev->kobj,
1239 		ret = sysfs_create_group(&ab8500->dev->kobj,
1242 	if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1243 			ab8500->chip_id >= AB8500_CUT2P0)
1244 		ret = sysfs_create_group(&ab8500->dev->kobj,
1248 		dev_err(ab8500->dev, "error creating sysfs entries\n");
1254 	{ "ab8500-core", AB8500_VERSION_AB8500 },
1263 		.name = "ab8500-core",