Lines Matching defs:stmpe
3 * ST Microelectronics MFD: stmpe's driver
23 #include "stmpe.h"
30 * @autosleep: bool to enable/disable stmpe autosleep
41 static int __stmpe_enable(struct stmpe *stmpe, unsigned int blocks)
43 return stmpe->variant->enable(stmpe, blocks, true);
46 static int __stmpe_disable(struct stmpe *stmpe, unsigned int blocks)
48 return stmpe->variant->enable(stmpe, blocks, false);
51 static int __stmpe_reg_read(struct stmpe *stmpe, u8 reg)
55 ret = stmpe->ci->read_byte(stmpe, reg);
57 dev_err(stmpe->dev, "failed to read reg %#x: %d\n", reg, ret);
59 dev_vdbg(stmpe->dev, "rd: reg %#x => data %#x\n", reg, ret);
64 static int __stmpe_reg_write(struct stmpe *stmpe, u8 reg, u8 val)
68 dev_vdbg(stmpe->dev, "wr: reg %#x <= %#x\n", reg, val);
70 ret = stmpe->ci->write_byte(stmpe, reg, val);
72 dev_err(stmpe->dev, "failed to write reg %#x: %d\n", reg, ret);
77 static int __stmpe_set_bits(struct stmpe *stmpe, u8 reg, u8 mask, u8 val)
81 ret = __stmpe_reg_read(stmpe, reg);
88 return __stmpe_reg_write(stmpe, reg, ret);
91 static int __stmpe_block_read(struct stmpe *stmpe, u8 reg, u8 length,
96 ret = stmpe->ci->read_block(stmpe, reg, length, values);
98 dev_err(stmpe->dev, "failed to read regs %#x: %d\n", reg, ret);
100 dev_vdbg(stmpe->dev, "rd: reg %#x (%d) => ret %#x\n", reg, length, ret);
101 stmpe_dump_bytes("stmpe rd: ", values, length);
106 static int __stmpe_block_write(struct stmpe *stmpe, u8 reg, u8 length,
111 dev_vdbg(stmpe->dev, "wr: regs %#x (%d)\n", reg, length);
112 stmpe_dump_bytes("stmpe wr: ", values, length);
114 ret = stmpe->ci->write_block(stmpe, reg, length, values);
116 dev_err(stmpe->dev, "failed to write regs %#x: %d\n", reg, ret);
123 * @stmpe: Device to work on
126 int stmpe_enable(struct stmpe *stmpe, unsigned int blocks)
130 mutex_lock(&stmpe->lock);
131 ret = __stmpe_enable(stmpe, blocks);
132 mutex_unlock(&stmpe->lock);
140 * @stmpe: Device to work on
143 int stmpe_disable(struct stmpe *stmpe, unsigned int blocks)
147 mutex_lock(&stmpe->lock);
148 ret = __stmpe_disable(stmpe, blocks);
149 mutex_unlock(&stmpe->lock);
157 * @stmpe: Device to read from
160 int stmpe_reg_read(struct stmpe *stmpe, u8 reg)
164 mutex_lock(&stmpe->lock);
165 ret = __stmpe_reg_read(stmpe, reg);
166 mutex_unlock(&stmpe->lock);
174 * @stmpe: Device to write to
178 int stmpe_reg_write(struct stmpe *stmpe, u8 reg, u8 val)
182 mutex_lock(&stmpe->lock);
183 ret = __stmpe_reg_write(stmpe, reg, val);
184 mutex_unlock(&stmpe->lock);
192 * @stmpe: Device to write to
197 int stmpe_set_bits(struct stmpe *stmpe, u8 reg, u8 mask, u8 val)
201 mutex_lock(&stmpe->lock);
202 ret = __stmpe_set_bits(stmpe, reg, mask, val);
203 mutex_unlock(&stmpe->lock);
211 * @stmpe: Device to read from
216 int stmpe_block_read(struct stmpe *stmpe, u8 reg, u8 length, u8 *values)
220 mutex_lock(&stmpe->lock);
221 ret = __stmpe_block_read(stmpe, reg, length, values);
222 mutex_unlock(&stmpe->lock);
230 * @stmpe: Device to write to
235 int stmpe_block_write(struct stmpe *stmpe, u8 reg, u8 length,
240 mutex_lock(&stmpe->lock);
241 ret = __stmpe_block_write(stmpe, reg, length, values);
242 mutex_unlock(&stmpe->lock);
250 * @stmpe: Device to configure
260 int stmpe_set_altfunc(struct stmpe *stmpe, u32 pins, enum stmpe_block block)
262 struct stmpe_variant_info *variant = stmpe->variant;
263 u8 regaddr = stmpe->regs[STMPE_IDX_GPAFR_U_MSB];
265 int numregs = DIV_ROUND_UP(stmpe->num_gpios * af_bits, 8);
274 mutex_lock(&stmpe->lock);
276 ret = __stmpe_enable(stmpe, STMPE_BLOCK_GPIO);
280 ret = __stmpe_block_read(stmpe, regaddr, numregs, regs);
284 af = variant->get_altfunc(stmpe, block);
297 ret = __stmpe_block_write(stmpe, regaddr, numregs, regs);
300 mutex_unlock(&stmpe->lock);
317 .name = "stmpe-gpio",
318 .of_compatible = "st,stmpe-gpio",
324 .name = "stmpe-gpio",
325 .of_compatible = "st,stmpe-gpio",
346 .name = "stmpe-keypad",
347 .of_compatible = "st,stmpe-keypad",
372 .name = "stmpe-pwm",
373 .of_compatible = "st,stmpe-pwm",
408 static int stmpe801_enable(struct stmpe *stmpe, unsigned int blocks,
457 .name = "stmpe-ts",
458 .of_compatible = "st,stmpe-ts",
480 .name = "stmpe-adc",
481 .of_compatible = "st,stmpe-adc",
527 static int stmpe811_enable(struct stmpe *stmpe, unsigned int blocks,
541 return __stmpe_set_bits(stmpe, stmpe->regs[STMPE_IDX_SYS_CTRL2], mask,
545 int stmpe811_adc_common_init(struct stmpe *stmpe)
550 adc_ctrl1 = STMPE_SAMPLE_TIME(stmpe->sample_time) |
551 STMPE_MOD_12B(stmpe->mod_12b) |
552 STMPE_REF_SEL(stmpe->ref_sel);
556 ret = stmpe_set_bits(stmpe, STMPE811_REG_ADC_CTRL1,
559 dev_err(stmpe->dev, "Could not setup ADC\n");
563 ret = stmpe_set_bits(stmpe, STMPE811_REG_ADC_CTRL2,
564 STMPE_ADC_FREQ(0xff), STMPE_ADC_FREQ(stmpe->adc_freq));
566 dev_err(stmpe->dev, "Could not setup ADC\n");
574 static int stmpe811_get_altfunc(struct stmpe *stmpe, enum stmpe_block block)
642 static int stmpe1600_enable(struct stmpe *stmpe, unsigned int blocks,
736 static int stmpe_autosleep(struct stmpe *stmpe, int autosleep_timeout)
740 if (!stmpe->variant->enable_autosleep)
743 mutex_lock(&stmpe->lock);
744 ret = stmpe->variant->enable_autosleep(stmpe, autosleep_timeout);
745 mutex_unlock(&stmpe->lock);
751 * Both stmpe 1601/2403 support same layout for autosleep
753 static int stmpe1601_autosleep(struct stmpe *stmpe,
761 dev_err(stmpe->dev, "invalid timeout\n");
765 ret = __stmpe_set_bits(stmpe, stmpe->regs[STMPE_IDX_SYS_CTRL2],
771 return __stmpe_set_bits(stmpe, stmpe->regs[STMPE_IDX_SYS_CTRL2],
776 static int stmpe1601_enable(struct stmpe *stmpe, unsigned int blocks,
796 return __stmpe_set_bits(stmpe, stmpe->regs[STMPE_IDX_SYS_CTRL], mask,
800 static int stmpe1601_get_altfunc(struct stmpe *stmpe, enum stmpe_block block)
877 static int stmpe1801_enable(struct stmpe *stmpe, unsigned int blocks,
887 return __stmpe_set_bits(stmpe, STMPE1801_REG_INT_EN_MASK_LOW, mask,
891 static int stmpe_reset(struct stmpe *stmpe)
893 u16 id_val = stmpe->variant->id_val;
905 ret = __stmpe_set_bits(stmpe, stmpe->regs[STMPE_IDX_SYS_CTRL],
914 ret = __stmpe_reg_read(stmpe, stmpe->regs[STMPE_IDX_SYS_CTRL]);
999 static int stmpe24xx_enable(struct stmpe *stmpe, unsigned int blocks,
1010 return __stmpe_set_bits(stmpe, stmpe->regs[STMPE_IDX_SYS_CTRL], mask,
1014 static int stmpe24xx_get_altfunc(struct stmpe *stmpe, enum stmpe_block block)
1082 struct stmpe *stmpe = data;
1083 struct stmpe_variant_info *variant = stmpe->variant;
1092 int base = irq_find_mapping(stmpe->domain, 0);
1099 israddr = stmpe->regs[STMPE_IDX_ISR_LSB];
1101 israddr = stmpe->regs[STMPE_IDX_ISR_MSB];
1103 ret = stmpe_block_read(stmpe, israddr, num, isr);
1112 status &= stmpe->ier[bank];
1120 int nestedirq = irq_find_mapping(stmpe->domain, line);
1126 stmpe_reg_write(stmpe, israddr + i, clear);
1134 struct stmpe *stmpe = irq_data_get_irq_chip_data(data);
1136 mutex_lock(&stmpe->irq_lock);
1141 struct stmpe *stmpe = irq_data_get_irq_chip_data(data);
1142 struct stmpe_variant_info *variant = stmpe->variant;
1147 u8 new = stmpe->ier[i];
1148 u8 old = stmpe->oldier[i];
1153 stmpe->oldier[i] = new;
1154 stmpe_reg_write(stmpe, stmpe->regs[STMPE_IDX_IER_LSB + i], new);
1157 mutex_unlock(&stmpe->irq_lock);
1162 struct stmpe *stmpe = irq_data_get_irq_chip_data(data);
1167 stmpe->ier[regoffset] &= ~mask;
1172 struct stmpe *stmpe = irq_data_get_irq_chip_data(data);
1177 stmpe->ier[regoffset] |= mask;
1181 .name = "stmpe",
1191 struct stmpe *stmpe = d->host_data;
1194 if (stmpe->variant->id_val != STMPE801_ID)
1197 irq_set_chip_data(virq, stmpe);
1217 static int stmpe_irq_init(struct stmpe *stmpe, struct device_node *np)
1220 int num_irqs = stmpe->variant->num_irqs;
1222 stmpe->domain = irq_domain_add_simple(np, num_irqs, base,
1223 &stmpe_irq_ops, stmpe);
1224 if (!stmpe->domain) {
1225 dev_err(stmpe->dev, "Failed to create irqdomain\n");
1232 static int stmpe_chip_init(struct stmpe *stmpe)
1234 unsigned int irq_trigger = stmpe->pdata->irq_trigger;
1235 int autosleep_timeout = stmpe->pdata->autosleep_timeout;
1236 struct stmpe_variant_info *variant = stmpe->variant;
1242 ret = stmpe_block_read(stmpe, stmpe->regs[STMPE_IDX_CHIP_ID],
1249 dev_err(stmpe->dev, "unknown chip id: %#x\n", id);
1253 dev_info(stmpe->dev, "%s detected, chip id: %#x\n", variant->name, id);
1256 ret = stmpe_disable(stmpe, ~0);
1260 ret = stmpe_reset(stmpe);
1264 if (stmpe->irq >= 0) {
1286 if (stmpe->pdata->autosleep) {
1287 ret = stmpe_autosleep(stmpe, autosleep_timeout);
1292 return stmpe_reg_write(stmpe, stmpe->regs[STMPE_IDX_ICR_LSB], icr);
1295 static int stmpe_add_device(struct stmpe *stmpe, const struct mfd_cell *cell)
1297 return mfd_add_devices(stmpe->dev, stmpe->pdata->id, cell, 1,
1298 NULL, 0, stmpe->domain);
1301 static int stmpe_devices_init(struct stmpe *stmpe)
1303 struct stmpe_variant_info *variant = stmpe->variant;
1304 unsigned int platform_blocks = stmpe->pdata->blocks;
1324 ret = stmpe_add_device(stmpe, block->cell);
1330 dev_warn(stmpe->dev,
1342 pdata->id = of_alias_get_id(np, "stmpe-i2c");
1370 struct stmpe *stmpe;
1384 stmpe = devm_kzalloc(ci->dev, sizeof(struct stmpe), GFP_KERNEL);
1385 if (!stmpe)
1388 mutex_init(&stmpe->irq_lock);
1389 mutex_init(&stmpe->lock);
1392 stmpe->sample_time = val;
1394 stmpe->mod_12b = val;
1396 stmpe->ref_sel = val;
1398 stmpe->adc_freq = val;
1400 stmpe->dev = ci->dev;
1401 stmpe->client = ci->client;
1402 stmpe->pdata = pdata;
1403 stmpe->ci = ci;
1404 stmpe->partnum = partnum;
1405 stmpe->variant = stmpe_variant_info[partnum];
1406 stmpe->regs = stmpe->variant->regs;
1407 stmpe->num_gpios = stmpe->variant->num_gpios;
1408 stmpe->vcc = devm_regulator_get_optional(ci->dev, "vcc");
1409 if (!IS_ERR(stmpe->vcc)) {
1410 ret = regulator_enable(stmpe->vcc);
1414 stmpe->vio = devm_regulator_get_optional(ci->dev, "vio");
1415 if (!IS_ERR(stmpe->vio)) {
1416 ret = regulator_enable(stmpe->vio);
1420 dev_set_drvdata(stmpe->dev, stmpe);
1423 ci->init(stmpe);
1428 dev_err(stmpe->dev, "failed to request IRQ GPIO: %d\n", ret);
1433 stmpe->irq = gpiod_to_irq(irq_gpio);
1437 stmpe->irq = ci->irq;
1441 if (stmpe->irq < 0) {
1443 dev_info(stmpe->dev,
1445 stmpe->variant->name);
1446 if (!stmpe_noirq_variant_info[stmpe->partnum]) {
1447 dev_err(stmpe->dev,
1449 stmpe->variant->name);
1452 stmpe->variant = stmpe_noirq_variant_info[stmpe->partnum];
1454 pdata->irq_trigger = irq_get_trigger_type(stmpe->irq);
1457 ret = stmpe_chip_init(stmpe);
1461 if (stmpe->irq >= 0) {
1462 ret = stmpe_irq_init(stmpe, np);
1466 ret = devm_request_threaded_irq(ci->dev, stmpe->irq, NULL,
1468 "stmpe", stmpe);
1470 dev_err(stmpe->dev, "failed to request IRQ: %d\n",
1476 ret = stmpe_devices_init(stmpe);
1480 dev_err(stmpe->dev, "failed to add children\n");
1481 mfd_remove_devices(stmpe->dev);
1486 void stmpe_remove(struct stmpe *stmpe)
1488 if (!IS_ERR(stmpe->vio) && regulator_is_enabled(stmpe->vio))
1489 regulator_disable(stmpe->vio);
1490 if (!IS_ERR(stmpe->vcc) && regulator_is_enabled(stmpe->vcc))
1491 regulator_disable(stmpe->vcc);
1493 __stmpe_disable(stmpe, STMPE_BLOCK_ADC);
1495 mfd_remove_devices(stmpe->dev);
1500 struct stmpe *stmpe = dev_get_drvdata(dev);
1502 if (stmpe->irq >= 0 && device_may_wakeup(dev))
1503 enable_irq_wake(stmpe->irq);
1510 struct stmpe *stmpe = dev_get_drvdata(dev);
1512 if (stmpe->irq >= 0 && device_may_wakeup(dev))
1513 disable_irq_wake(stmpe->irq);