20 struct adnp {  struct
36 static int adnp_read(struct adnp *adnp, unsigned offset, uint8_t *value)  in adnp_read()  argument
40 	err = i2c_smbus_read_byte_data(adnp->client, offset);  in adnp_read()
42 		dev_err(adnp->gpio.parent, "%s failed: %d\n",  in adnp_read()
51 static int adnp_write(struct adnp *adnp, unsigned offset, uint8_t value)  in adnp_write()  argument
55 	err = i2c_smbus_write_byte_data(adnp->client, offset, value);  in adnp_write()
57 		dev_err(adnp->gpio.parent, "%s failed: %d\n",  in adnp_write()
67 	struct adnp *adnp = gpiochip_get_data(chip);  in adnp_gpio_get()  local
68 	unsigned int reg = offset >> adnp->reg_shift;  in adnp_gpio_get()
73 	err = adnp_read(adnp, GPIO_PLR(adnp) + reg, &value);  in adnp_gpio_get()
80 static void __adnp_gpio_set(struct adnp *adnp, unsigned offset, int value)  in __adnp_gpio_set()  argument
82 	unsigned int reg = offset >> adnp->reg_shift;  in __adnp_gpio_set()
87 	err = adnp_read(adnp, GPIO_PLR(adnp) + reg, &val);  in __adnp_gpio_set()
96 	adnp_write(adnp, GPIO_PLR(adnp) + reg, val);  in __adnp_gpio_set()
101 	struct adnp *adnp = gpiochip_get_data(chip);  in adnp_gpio_set()  local
103 	mutex_lock(&adnp->i2c_lock);  in adnp_gpio_set()
104 	__adnp_gpio_set(adnp, offset, value);  in adnp_gpio_set()
105 	mutex_unlock(&adnp->i2c_lock);  in adnp_gpio_set()
110 	struct adnp *adnp = gpiochip_get_data(chip);  in adnp_gpio_direction_input()  local
111 	unsigned int reg = offset >> adnp->reg_shift;  in adnp_gpio_direction_input()
116 	mutex_lock(&adnp->i2c_lock);  in adnp_gpio_direction_input()
118 	err = adnp_read(adnp, GPIO_DDR(adnp) + reg, &value);  in adnp_gpio_direction_input()
124 	err = adnp_write(adnp, GPIO_DDR(adnp) + reg, value);  in adnp_gpio_direction_input()
128 	err = adnp_read(adnp, GPIO_DDR(adnp) + reg, &value);  in adnp_gpio_direction_input()
140 	mutex_unlock(&adnp->i2c_lock);  in adnp_gpio_direction_input()
147 	struct adnp *adnp = gpiochip_get_data(chip);  in adnp_gpio_direction_output()  local
148 	unsigned int reg = offset >> adnp->reg_shift;  in adnp_gpio_direction_output()
153 	mutex_lock(&adnp->i2c_lock);  in adnp_gpio_direction_output()
155 	err = adnp_read(adnp, GPIO_DDR(adnp) + reg, &val);  in adnp_gpio_direction_output()
161 	err = adnp_write(adnp, GPIO_DDR(adnp) + reg, val);  in adnp_gpio_direction_output()
165 	err = adnp_read(adnp, GPIO_DDR(adnp) + reg, &val);  in adnp_gpio_direction_output()
174 	__adnp_gpio_set(adnp, offset, value);  in adnp_gpio_direction_output()
178 	mutex_unlock(&adnp->i2c_lock);  in adnp_gpio_direction_output()
184 	struct adnp *adnp = gpiochip_get_data(chip);  in adnp_gpio_dbg_show()  local
185 	unsigned int num_regs = 1 << adnp->reg_shift, i, j;  in adnp_gpio_dbg_show()
191 		mutex_lock(&adnp->i2c_lock);  in adnp_gpio_dbg_show()
193 		err = adnp_read(adnp, GPIO_DDR(adnp) + i, &ddr);  in adnp_gpio_dbg_show()
197 		err = adnp_read(adnp, GPIO_PLR(adnp) + i, &plr);  in adnp_gpio_dbg_show()
201 		err = adnp_read(adnp, GPIO_IER(adnp) + i, &ier);  in adnp_gpio_dbg_show()
205 		err = adnp_read(adnp, GPIO_ISR(adnp) + i, &isr);  in adnp_gpio_dbg_show()
209 		mutex_unlock(&adnp->i2c_lock);  in adnp_gpio_dbg_show()
212 			unsigned int bit = (i << adnp->reg_shift) + j;  in adnp_gpio_dbg_show()
238 	mutex_unlock(&adnp->i2c_lock);  in adnp_gpio_dbg_show()
243 	struct adnp *adnp = data;  in adnp_irq()  local
246 	num_regs = 1 << adnp->reg_shift;  in adnp_irq()
249 		unsigned int base = i << adnp->reg_shift, bit;  in adnp_irq()
254 		mutex_lock(&adnp->i2c_lock);  in adnp_irq()
256 		err = adnp_read(adnp, GPIO_PLR(adnp) + i, &level);  in adnp_irq()
258 			mutex_unlock(&adnp->i2c_lock);  in adnp_irq()
262 		err = adnp_read(adnp, GPIO_ISR(adnp) + i, &isr);  in adnp_irq()
264 			mutex_unlock(&adnp->i2c_lock);  in adnp_irq()
268 		err = adnp_read(adnp, GPIO_IER(adnp) + i, &ier);  in adnp_irq()
270 			mutex_unlock(&adnp->i2c_lock);  in adnp_irq()
274 		mutex_unlock(&adnp->i2c_lock);  in adnp_irq()
277 		changed = level ^ adnp->irq_level[i];  in adnp_irq()
280 		pending = changed & ((adnp->irq_fall[i] & ~level) |  in adnp_irq()
281 				     (adnp->irq_rise[i] & level));  in adnp_irq()
284 		pending |= (adnp->irq_high[i] & level) |  in adnp_irq()
285 			   (adnp->irq_low[i] & ~level);  in adnp_irq()
292 			child_irq = irq_find_mapping(adnp->gpio.irq.domain,  in adnp_irq()
304 	struct adnp *adnp = gpiochip_get_data(gc);  in adnp_irq_mask()  local
305 	unsigned int reg = d->hwirq >> adnp->reg_shift;  in adnp_irq_mask()
308 	adnp->irq_enable[reg] &= ~BIT(pos);  in adnp_irq_mask()
314 	struct adnp *adnp = gpiochip_get_data(gc);  in adnp_irq_unmask()  local
315 	unsigned int reg = d->hwirq >> adnp->reg_shift;  in adnp_irq_unmask()
318 	adnp->irq_enable[reg] |= BIT(pos);  in adnp_irq_unmask()
324 	struct adnp *adnp = gpiochip_get_data(gc);  in adnp_irq_set_type()  local
325 	unsigned int reg = d->hwirq >> adnp->reg_shift;  in adnp_irq_set_type()
329 		adnp->irq_rise[reg] |= BIT(pos);  in adnp_irq_set_type()
331 		adnp->irq_rise[reg] &= ~BIT(pos);  in adnp_irq_set_type()
334 		adnp->irq_fall[reg] |= BIT(pos);  in adnp_irq_set_type()
336 		adnp->irq_fall[reg] &= ~BIT(pos);  in adnp_irq_set_type()
339 		adnp->irq_high[reg] |= BIT(pos);  in adnp_irq_set_type()
341 		adnp->irq_high[reg] &= ~BIT(pos);  in adnp_irq_set_type()
344 		adnp->irq_low[reg] |= BIT(pos);  in adnp_irq_set_type()
346 		adnp->irq_low[reg] &= ~BIT(pos);  in adnp_irq_set_type()
354 	struct adnp *adnp = gpiochip_get_data(gc);  in adnp_irq_bus_lock()  local
356 	mutex_lock(&adnp->irq_lock);  in adnp_irq_bus_lock()
362 	struct adnp *adnp = gpiochip_get_data(gc);  in adnp_irq_bus_unlock()  local
363 	unsigned int num_regs = 1 << adnp->reg_shift, i;  in adnp_irq_bus_unlock()
365 	mutex_lock(&adnp->i2c_lock);  in adnp_irq_bus_unlock()
368 		adnp_write(adnp, GPIO_IER(adnp) + i, adnp->irq_enable[i]);  in adnp_irq_bus_unlock()
370 	mutex_unlock(&adnp->i2c_lock);  in adnp_irq_bus_unlock()
371 	mutex_unlock(&adnp->irq_lock);  in adnp_irq_bus_unlock()
383 static int adnp_irq_setup(struct adnp *adnp)  in adnp_irq_setup()  argument
385 	unsigned int num_regs = 1 << adnp->reg_shift, i;  in adnp_irq_setup()
386 	struct gpio_chip *chip = &adnp->gpio;  in adnp_irq_setup()
389 	mutex_init(&adnp->irq_lock);  in adnp_irq_setup()
399 	adnp->irq_enable = devm_kcalloc(chip->parent, num_regs, 6,  in adnp_irq_setup()
401 	if (!adnp->irq_enable)  in adnp_irq_setup()
404 	adnp->irq_level = adnp->irq_enable + (num_regs * 1);  in adnp_irq_setup()
405 	adnp->irq_rise = adnp->irq_enable + (num_regs * 2);  in adnp_irq_setup()
406 	adnp->irq_fall = adnp->irq_enable + (num_regs * 3);  in adnp_irq_setup()
407 	adnp->irq_high = adnp->irq_enable + (num_regs * 4);  in adnp_irq_setup()
408 	adnp->irq_low = adnp->irq_enable + (num_regs * 5);  in adnp_irq_setup()
415 		err = adnp_read(adnp, GPIO_PLR(adnp) + i, &adnp->irq_level[i]);  in adnp_irq_setup()
420 		err = adnp_write(adnp, GPIO_IER(adnp) + i, 0);  in adnp_irq_setup()
424 		adnp->irq_enable[i] = 0x00;  in adnp_irq_setup()
427 	err = devm_request_threaded_irq(chip->parent, adnp->client->irq,  in adnp_irq_setup()
430 					dev_name(chip->parent), adnp);  in adnp_irq_setup()
433 			adnp->client->irq, err);  in adnp_irq_setup()
440 static int adnp_gpio_setup(struct adnp *adnp, unsigned int num_gpios,  in adnp_gpio_setup()  argument
443 	struct gpio_chip *chip = &adnp->gpio;  in adnp_gpio_setup()
446 	adnp->reg_shift = get_count_order(num_gpios) - 3;  in adnp_gpio_setup()
459 	chip->label = adnp->client->name;  in adnp_gpio_setup()
460 	chip->parent = &adnp->client->dev;  in adnp_gpio_setup()
467 		err = adnp_irq_setup(adnp);  in adnp_gpio_setup()
482 	err = devm_gpiochip_add_data(&adnp->client->dev, chip, adnp);  in adnp_gpio_setup()
493 	struct adnp *adnp;  in adnp_i2c_probe()  local
505 	adnp = devm_kzalloc(&client->dev, sizeof(*adnp), GFP_KERNEL);  in adnp_i2c_probe()
506 	if (!adnp)  in adnp_i2c_probe()
509 	mutex_init(&adnp->i2c_lock);  in adnp_i2c_probe()
510 	adnp->client = client;  in adnp_i2c_probe()
512 	err = adnp_gpio_setup(adnp, num_gpios,  in adnp_i2c_probe()
517 	i2c_set_clientdata(client, adnp);  in adnp_i2c_probe()