drivers/pinctrl/pinctrl-sx150x.c

372 static bool sx150x_pin_is_oscio(struct sx150x_pinctrl *pctl, unsigned int pin)
374 	if (pin >= pctl->data->npins)
378 	if (pctl->data->model != SX150X_789)
381 	return !strcmp(pctl->data->pins[pin].name, "oscio");
387 	struct sx150x_pinctrl *pctl = gpiochip_get_data(chip);
391 	if (sx150x_pin_is_oscio(pctl, offset))
394 	ret = regmap_read(pctl->regmap, pctl->data->reg_dir, &value);
406 	struct sx150x_pinctrl *pctl = gpiochip_get_data(chip);
410 	if (sx150x_pin_is_oscio(pctl, offset))
413 	ret = regmap_read(pctl->regmap, pctl->data->reg_data, &value);
420 static int __sx150x_gpio_set(struct sx150x_pinctrl *pctl, unsigned int offset,
423 	return regmap_write_bits(pctl->regmap, pctl->data->reg_data,
427 static int sx150x_gpio_oscio_set(struct sx150x_pinctrl *pctl,
430 	return regmap_write(pctl->regmap,
431 			    pctl->data->pri.x789.reg_clock,
438 	struct sx150x_pinctrl *pctl = gpiochip_get_data(chip);
440 	if (sx150x_pin_is_oscio(pctl, offset))
441 		sx150x_gpio_oscio_set(pctl, value);
443 		__sx150x_gpio_set(pctl, offset, value);
450 	struct sx150x_pinctrl *pctl = gpiochip_get_data(chip);
452 	regmap_write_bits(pctl->regmap, pctl->data->reg_data, *mask, *bits);
458 	struct sx150x_pinctrl *pctl = gpiochip_get_data(chip);
460 	if (sx150x_pin_is_oscio(pctl, offset))
463 	return regmap_write_bits(pctl->regmap,
464 				 pctl->data->reg_dir,
471 	struct sx150x_pinctrl *pctl = gpiochip_get_data(chip);
474 	if (sx150x_pin_is_oscio(pctl, offset))
475 		return sx150x_gpio_oscio_set(pctl, value);
477 	ret = __sx150x_gpio_set(pctl, offset, value);
481 	return regmap_write_bits(pctl->regmap,
482 				 pctl->data->reg_dir,
489 	struct sx150x_pinctrl *pctl = gpiochip_get_data(gc);
492 	pctl->irq.masked |= BIT(n);
499 	struct sx150x_pinctrl *pctl = gpiochip_get_data(gc);
503 	pctl->irq.masked &= ~BIT(n);
506 static void sx150x_irq_set_sense(struct sx150x_pinctrl *pctl,
517 	pctl->irq.sense &= mask;
518 	pctl->irq.sense |= sense << n;
524 	struct sx150x_pinctrl *pctl = gpiochip_get_data(gc);
537 	sx150x_irq_set_sense(pctl, n, val);
543 	struct sx150x_pinctrl *pctl = (struct sx150x_pinctrl *)dev_id;
548 	err = regmap_read(pctl->regmap, pctl->data->reg_irq_src, &val);
552 	err = regmap_write(pctl->regmap, pctl->data->reg_irq_src, val);
557 	for_each_set_bit(n, &status, pctl->data->ngpios)
558 		handle_nested_irq(irq_find_mapping(pctl->gpio.irq.domain, n));
566 	struct sx150x_pinctrl *pctl = gpiochip_get_data(gc);
568 	mutex_lock(&pctl->lock);
574 	struct sx150x_pinctrl *pctl = gpiochip_get_data(gc);
576 	regmap_write(pctl->regmap, pctl->data->reg_irq_mask, pctl->irq.masked);
577 	regmap_write(pctl->regmap, pctl->data->reg_sense, pctl->irq.sense);
578 	mutex_unlock(&pctl->lock);
585 	struct sx150x_pinctrl *pctl = gpiochip_get_data(gc);
587 	seq_printf(p, pctl->client->name);
604 	struct sx150x_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);
610 	if (sx150x_pin_is_oscio(pctl, pin)) {
614 			ret = regmap_read(pctl->regmap,
615 					  pctl->data->pri.x789.reg_clock,
641 		ret = regmap_read(pctl->regmap,
642 				  pctl->data->reg_pulldn,
656 		ret = regmap_read(pctl->regmap,
657 				  pctl->data->reg_pullup,
671 		if (pctl->data->model != SX150X_789)
674 		ret = regmap_read(pctl->regmap,
675 				  pctl->data->pri.x789.reg_drain,
689 		if (pctl->data->model != SX150X_789)
692 			ret = regmap_read(pctl->regmap,
693 					  pctl->data->pri.x789.reg_drain,
708 		ret = sx150x_gpio_get_direction(&pctl->gpio, pin);
715 		ret = sx150x_gpio_get(&pctl->gpio, pin);
735 	struct sx150x_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);
745 		if (sx150x_pin_is_oscio(pctl, pin)) {
747 				ret = sx150x_gpio_direction_output(&pctl->gpio,
760 			ret = regmap_write_bits(pctl->regmap,
761 						pctl->data->reg_pulldn,
766 			ret = regmap_write_bits(pctl->regmap,
767 						pctl->data->reg_pullup,
775 			ret = regmap_write_bits(pctl->regmap,
776 						pctl->data->reg_pullup,
784 			ret = regmap_write_bits(pctl->regmap,
785 						pctl->data->reg_pulldn,
793 			if (pctl->data->model != SX150X_789 ||
794 			    sx150x_pin_is_oscio(pctl, pin))
797 			ret = regmap_write_bits(pctl->regmap,
798 						pctl->data->pri.x789.reg_drain,
806 			if (pctl->data->model != SX150X_789 ||
807 			    sx150x_pin_is_oscio(pctl, pin))
810 			ret = regmap_write_bits(pctl->regmap,
811 						pctl->data->pri.x789.reg_drain,
819 			ret = sx150x_gpio_direction_output(&pctl->gpio,
866 static int sx150x_reset(struct sx150x_pinctrl *pctl)
870 	err = i2c_smbus_write_byte_data(pctl->client,
871 					pctl->data->pri.x789.reg_reset,
876 	err = i2c_smbus_write_byte_data(pctl->client,
877 					pctl->data->pri.x789.reg_reset,
882 static int sx150x_init_misc(struct sx150x_pinctrl *pctl)
886 	switch (pctl->data->model) {
888 		reg   = pctl->data->pri.x789.reg_misc;
892 		reg   = pctl->data->pri.x456.reg_advanced;
903 		reg   = pctl->data->pri.x123.reg_advanced;
907 		WARN(1, "Unknown chip model %d\n", pctl->data->model);
911 	return regmap_write(pctl->regmap, reg, value);
914 static int sx150x_init_hw(struct sx150x_pinctrl *pctl)
917 		[SX150X_789] = pctl->data->pri.x789.reg_polarity,
918 		[SX150X_456] = pctl->data->pri.x456.reg_pld_mode,
919 		[SX150X_123] = pctl->data->pri.x123.reg_pld_mode,
923 	if (pctl->data->model == SX150X_789 &&
924 	    of_property_read_bool(pctl->dev->of_node, "semtech,probe-reset")) {
925 		err = sx150x_reset(pctl);
930 	err = sx150x_init_misc(pctl);
935 	return regmap_write(pctl->regmap, reg[pctl->data->model], 0);
938 static int sx150x_regmap_reg_width(struct sx150x_pinctrl *pctl,
941 	const struct sx150x_device_data *data = pctl->data;
967 static unsigned int sx150x_maybe_swizzle(struct sx150x_pinctrl *pctl,
971 	const struct sx150x_device_data *data = pctl->data;
1023 	struct sx150x_pinctrl *pctl = context;
1024 	struct i2c_client *i2c = pctl->client;
1025 	const int width = sx150x_regmap_reg_width(pctl, reg);
1067 	*result = sx150x_maybe_swizzle(pctl, reg, val);
1076 	struct sx150x_pinctrl *pctl = context;
1077 	struct i2c_client *i2c = pctl->client;
1078 	const int width = sx150x_regmap_reg_width(pctl, reg);
1080 	val = sx150x_maybe_swizzle(pctl, reg, val);
1099 	struct sx150x_pinctrl *pctl = i2c_get_clientdata(to_i2c_client(dev));
1101 	return reg == pctl->data->reg_irq_src || reg == pctl->data->reg_data;
1122 	struct sx150x_pinctrl *pctl;
1128 	pctl = devm_kzalloc(dev, sizeof(*pctl), GFP_KERNEL);
1129 	if (!pctl)
1132 	i2c_set_clientdata(client, pctl);
1134 	pctl->dev = dev;
1135 	pctl->client = client;
1137 	pctl->data = i2c_get_match_data(client);
1138 	if (!pctl->data)
1141 	pctl->regmap = devm_regmap_init(dev, NULL, pctl,
1143 	if (IS_ERR(pctl->regmap)) {
1144 		ret = PTR_ERR(pctl->regmap);
1150 	mutex_init(&pctl->lock);
1152 	ret = sx150x_init_hw(pctl);
1157 	pctl->pinctrl_desc.name = "sx150x-pinctrl";
1158 	pctl->pinctrl_desc.pctlops = &sx150x_pinctrl_ops;
1159 	pctl->pinctrl_desc.confops = &sx150x_pinconf_ops;
1160 	pctl->pinctrl_desc.pins = pctl->data->pins;
1161 	pctl->pinctrl_desc.npins = pctl->data->npins;
1162 	pctl->pinctrl_desc.owner = THIS_MODULE;
1164 	ret = devm_pinctrl_register_and_init(dev, &pctl->pinctrl_desc,
1165 					     pctl, &pctl->pctldev);
1172 	pctl->gpio.base = -1;
1173 	pctl->gpio.ngpio = pctl->data->npins;
1174 	pctl->gpio.get_direction = sx150x_gpio_get_direction;
1175 	pctl->gpio.direction_input = sx150x_gpio_direction_input;
1176 	pctl->gpio.direction_output = sx150x_gpio_direction_output;
1177 	pctl->gpio.get = sx150x_gpio_get;
1178 	pctl->gpio.set = sx150x_gpio_set;
1179 	pctl->gpio.set_config = gpiochip_generic_config;
1180 	pctl->gpio.parent = dev;
1181 	pctl->gpio.can_sleep = true;
1182 	pctl->gpio.label = devm_kstrdup(dev, client->name, GFP_KERNEL);
1183 	if (!pctl->gpio.label)
1192 	if (pctl->data->model != SX150X_789)
1193 		pctl->gpio.set_multiple = sx150x_gpio_set_multiple;
1199 		pctl->irq.masked = ~0;
1200 		pctl->irq.sense = 0;
1212 		girq = &pctl->gpio.irq;
1226 						client->name, pctl);
1231 	ret = devm_gpiochip_add_data(dev, &pctl->gpio, pctl);
1240 	ret = pinctrl_enable(pctl->pctldev);
1246 	ret = gpiochip_add_pin_range(&pctl->gpio, dev_name(dev),
1247 				     0, 0, pctl->data->npins);