116 int stmfx_function_enable(struct stmfx *stmfx, u32 func)  in stmfx_function_enable()  argument
122 	ret = regmap_read(stmfx->map, STMFX_REG_SYS_CTRL, &sys_ctrl);  in stmfx_function_enable()
134 		dev_err(stmfx->dev, "ALTGPIO function already enabled\n");  in stmfx_function_enable()
141 		dev_err(stmfx->dev, "TS in use, aGPIO[3:0] unavailable\n");  in stmfx_function_enable()
148 		dev_err(stmfx->dev, "IDD in use, aGPIO[7:4] unavailable\n");  in stmfx_function_enable()
154 	return regmap_update_bits(stmfx->map, STMFX_REG_SYS_CTRL, mask, mask);  in stmfx_function_enable()
158 int stmfx_function_disable(struct stmfx *stmfx, u32 func)  in stmfx_function_disable()  argument
162 	return regmap_update_bits(stmfx->map, STMFX_REG_SYS_CTRL, mask, 0);  in stmfx_function_disable()
168 	struct stmfx *stmfx = irq_data_get_irq_chip_data(data);  in stmfx_irq_bus_lock()  local
170 	mutex_lock(&stmfx->lock);  in stmfx_irq_bus_lock()
175 	struct stmfx *stmfx = irq_data_get_irq_chip_data(data);  in stmfx_irq_bus_sync_unlock()  local
177 	regmap_write(stmfx->map, STMFX_REG_IRQ_SRC_EN, stmfx->irq_src);  in stmfx_irq_bus_sync_unlock()
179 	mutex_unlock(&stmfx->lock);  in stmfx_irq_bus_sync_unlock()
184 	struct stmfx *stmfx = irq_data_get_irq_chip_data(data);  in stmfx_irq_mask()  local
186 	stmfx->irq_src &= ~BIT(data->hwirq % 8);  in stmfx_irq_mask()
191 	struct stmfx *stmfx = irq_data_get_irq_chip_data(data);  in stmfx_irq_unmask()  local
193 	stmfx->irq_src |= BIT(data->hwirq % 8);  in stmfx_irq_unmask()
206 	struct stmfx *stmfx = data;  in stmfx_irq_handler()  local
211 	ret = regmap_read(stmfx->map, STMFX_REG_IRQ_PENDING, &pending);  in stmfx_irq_handler()
221 		ret = regmap_write(stmfx->map, STMFX_REG_IRQ_ACK, ack);  in stmfx_irq_handler()
228 		handle_nested_irq(irq_find_mapping(stmfx->irq_domain, n));  in stmfx_irq_handler()
257 	struct stmfx *stmfx = i2c_get_clientdata(client);  in stmfx_irq_exit()  local
261 		irq_dispose_mapping(irq_find_mapping(stmfx->irq_domain, hwirq));  in stmfx_irq_exit()
263 	irq_domain_remove(stmfx->irq_domain);  in stmfx_irq_exit()
268 	struct stmfx *stmfx = i2c_get_clientdata(client);  in stmfx_irq_init()  local
272 	stmfx->irq_domain = irq_domain_add_simple(stmfx->dev->of_node,  in stmfx_irq_init()
274 						  &stmfx_irq_ops, stmfx);  in stmfx_irq_init()
275 	if (!stmfx->irq_domain) {  in stmfx_irq_init()
276 		dev_err(stmfx->dev, "Failed to create IRQ domain\n");  in stmfx_irq_init()
280 	if (!of_property_read_bool(stmfx->dev->of_node, "drive-open-drain"))  in stmfx_irq_init()
288 	ret = regmap_write(stmfx->map, STMFX_REG_IRQ_OUT_PIN, irqoutpin);  in stmfx_irq_init()
292 	ret = devm_request_threaded_irq(stmfx->dev, client->irq,  in stmfx_irq_init()
295 					"stmfx", stmfx);  in stmfx_irq_init()
302 static int stmfx_chip_reset(struct stmfx *stmfx)  in stmfx_chip_reset()  argument
306 	ret = regmap_write(stmfx->map, STMFX_REG_SYS_CTRL,  in stmfx_chip_reset()
318 	struct stmfx *stmfx = i2c_get_clientdata(client);  in stmfx_chip_init()  local
323 	stmfx->vdd = devm_regulator_get_optional(&client->dev, "vdd");  in stmfx_chip_init()
324 	ret = PTR_ERR_OR_ZERO(stmfx->vdd);  in stmfx_chip_init()
326 		stmfx->vdd = NULL;  in stmfx_chip_init()
334 	if (stmfx->vdd) {  in stmfx_chip_init()
335 		ret = regulator_enable(stmfx->vdd);  in stmfx_chip_init()
342 	ret = regmap_read(stmfx->map, STMFX_REG_CHIP_ID, &id);  in stmfx_chip_init()
365 	ret = regmap_bulk_read(stmfx->map, STMFX_REG_FW_VERSION_MSB,  in stmfx_chip_init()
375 	ret = stmfx_chip_reset(stmfx);  in stmfx_chip_init()
384 	if (stmfx->vdd)  in stmfx_chip_init()
385 		return regulator_disable(stmfx->vdd);  in stmfx_chip_init()
392 	struct stmfx *stmfx = i2c_get_clientdata(client);  in stmfx_chip_exit()  local
394 	regmap_write(stmfx->map, STMFX_REG_IRQ_SRC_EN, 0);  in stmfx_chip_exit()
395 	regmap_write(stmfx->map, STMFX_REG_SYS_CTRL, 0);  in stmfx_chip_exit()
397 	if (stmfx->vdd)  in stmfx_chip_exit()
398 		return regulator_disable(stmfx->vdd);  in stmfx_chip_exit()
407 	struct stmfx *stmfx;  in stmfx_probe()  local
410 	stmfx = devm_kzalloc(dev, sizeof(*stmfx), GFP_KERNEL);  in stmfx_probe()
411 	if (!stmfx)  in stmfx_probe()
414 	i2c_set_clientdata(client, stmfx);  in stmfx_probe()
416 	stmfx->dev = dev;  in stmfx_probe()
418 	stmfx->map = devm_regmap_init_i2c(client, &stmfx_regmap_config);  in stmfx_probe()
419 	if (IS_ERR(stmfx->map)) {  in stmfx_probe()
420 		ret = PTR_ERR(stmfx->map);  in stmfx_probe()
425 	mutex_init(&stmfx->lock);  in stmfx_probe()
446 				   0, stmfx->irq_domain);  in stmfx_probe()
470 	struct stmfx *stmfx = dev_get_drvdata(dev);  in stmfx_suspend()  local
473 	ret = regmap_raw_read(stmfx->map, STMFX_REG_SYS_CTRL,  in stmfx_suspend()
474 			      &stmfx->bkp_sysctrl, sizeof(stmfx->bkp_sysctrl));  in stmfx_suspend()
478 	ret = regmap_raw_read(stmfx->map, STMFX_REG_IRQ_OUT_PIN,  in stmfx_suspend()
479 			      &stmfx->bkp_irqoutpin,  in stmfx_suspend()
480 			      sizeof(stmfx->bkp_irqoutpin));  in stmfx_suspend()
484 	if (stmfx->vdd)  in stmfx_suspend()
485 		return regulator_disable(stmfx->vdd);  in stmfx_suspend()
492 	struct stmfx *stmfx = dev_get_drvdata(dev);  in stmfx_resume()  local
495 	if (stmfx->vdd) {  in stmfx_resume()
496 		ret = regulator_enable(stmfx->vdd);  in stmfx_resume()
498 			dev_err(stmfx->dev,  in stmfx_resume()
504 	ret = regmap_raw_write(stmfx->map, STMFX_REG_SYS_CTRL,  in stmfx_resume()
505 			       &stmfx->bkp_sysctrl, sizeof(stmfx->bkp_sysctrl));  in stmfx_resume()
509 	ret = regmap_raw_write(stmfx->map, STMFX_REG_IRQ_OUT_PIN,  in stmfx_resume()
510 			       &stmfx->bkp_irqoutpin,  in stmfx_resume()
511 			       sizeof(stmfx->bkp_irqoutpin));  in stmfx_resume()
515 	ret = regmap_raw_write(stmfx->map, STMFX_REG_IRQ_SRC_EN,  in stmfx_resume()
516 			       &stmfx->irq_src, sizeof(stmfx->irq_src));  in stmfx_resume()