|
@@ -144,8 +144,9 @@ static int stmpe_gpio_irq_set_type(struct irq_data *d, unsigned int type)
|
|
|
if (type & IRQ_TYPE_LEVEL_LOW || type & IRQ_TYPE_LEVEL_HIGH)
|
|
|
return -EINVAL;
|
|
|
|
|
|
- /* STMPE801 doesn't have RE and FE registers */
|
|
|
- if (stmpe_gpio->stmpe->partnum == STMPE801)
|
|
|
+ /* STMPE801 and STMPE 1600 don't have RE and FE registers */
|
|
|
+ if (stmpe_gpio->stmpe->partnum == STMPE801 ||
|
|
|
+ stmpe_gpio->stmpe->partnum == STMPE1600)
|
|
|
return 0;
|
|
|
|
|
|
if (type & IRQ_TYPE_EDGE_RISING)
|
|
@@ -189,9 +190,10 @@ static void stmpe_gpio_irq_sync_unlock(struct irq_data *d)
|
|
|
int i, j;
|
|
|
|
|
|
for (i = 0; i < CACHE_NR_REGS; i++) {
|
|
|
- /* STMPE801 doesn't have RE and FE registers */
|
|
|
- if ((stmpe->partnum == STMPE801) &&
|
|
|
- (i != REG_IE))
|
|
|
+ /* STMPE801 and STMPE1600 don't have RE and FE registers */
|
|
|
+ if ((stmpe->partnum == STMPE801 ||
|
|
|
+ stmpe->partnum == STMPE1600) &&
|
|
|
+ (i != REG_IE))
|
|
|
continue;
|
|
|
|
|
|
for (j = 0; j < num_banks; j++) {
|
|
@@ -224,11 +226,21 @@ static void stmpe_gpio_irq_unmask(struct irq_data *d)
|
|
|
{
|
|
|
struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
|
|
|
struct stmpe_gpio *stmpe_gpio = gpiochip_get_data(gc);
|
|
|
+ struct stmpe *stmpe = stmpe_gpio->stmpe;
|
|
|
int offset = d->hwirq;
|
|
|
int regoffset = offset / 8;
|
|
|
int mask = 1 << (offset % 8);
|
|
|
|
|
|
stmpe_gpio->regs[REG_IE][regoffset] |= mask;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * STMPE1600 workaround: to be able to get IRQ from pins,
|
|
|
+ * a read must be done on GPMR register, or a write in
|
|
|
+ * GPSR or GPCR registers
|
|
|
+ */
|
|
|
+ if (stmpe->partnum == STMPE1600)
|
|
|
+ stmpe_reg_read(stmpe,
|
|
|
+ stmpe->regs[STMPE_IDX_GPMR_LSB + regoffset]);
|
|
|
}
|
|
|
|
|
|
static void stmpe_dbg_show_one(struct seq_file *s,
|
|
@@ -301,6 +313,7 @@ static void stmpe_dbg_show_one(struct seq_file *s,
|
|
|
fall = !!(ret & mask);
|
|
|
|
|
|
case STMPE801:
|
|
|
+ case STMPE1600:
|
|
|
irqen_reg = stmpe->regs[STMPE_IDX_IEGPIOR_LSB + bank];
|
|
|
break;
|
|
|
|
|
@@ -347,18 +360,32 @@ static irqreturn_t stmpe_gpio_irq(int irq, void *dev)
|
|
|
{
|
|
|
struct stmpe_gpio *stmpe_gpio = dev;
|
|
|
struct stmpe *stmpe = stmpe_gpio->stmpe;
|
|
|
- u8 statmsbreg = stmpe->regs[STMPE_IDX_ISGPIOR_MSB];
|
|
|
+ u8 statmsbreg;
|
|
|
int num_banks = DIV_ROUND_UP(stmpe->num_gpios, 8);
|
|
|
u8 status[num_banks];
|
|
|
int ret;
|
|
|
int i;
|
|
|
|
|
|
+ /*
|
|
|
+ * the stmpe_block_read() call below, imposes to set statmsbreg
|
|
|
+ * with the register located at the lowest address. As STMPE1600
|
|
|
+ * variant is the only one which respect registers address's order
|
|
|
+ * (LSB regs located at lowest address than MSB ones) whereas all
|
|
|
+ * the others have a registers layout with MSB located before the
|
|
|
+ * LSB regs.
|
|
|
+ */
|
|
|
+ if (stmpe->partnum == STMPE1600)
|
|
|
+ statmsbreg = stmpe->regs[STMPE_IDX_ISGPIOR_LSB];
|
|
|
+ else
|
|
|
+ statmsbreg = stmpe->regs[STMPE_IDX_ISGPIOR_MSB];
|
|
|
+
|
|
|
ret = stmpe_block_read(stmpe, statmsbreg, num_banks, status);
|
|
|
if (ret < 0)
|
|
|
return IRQ_NONE;
|
|
|
|
|
|
for (i = 0; i < num_banks; i++) {
|
|
|
- int bank = num_banks - i - 1;
|
|
|
+ int bank = (stmpe_gpio->stmpe->partnum == STMPE1600) ? i :
|
|
|
+ num_banks - i - 1;
|
|
|
unsigned int enabled = stmpe_gpio->regs[REG_IE][bank];
|
|
|
unsigned int stat = status[i];
|
|
|
|
|
@@ -378,10 +405,11 @@ static irqreturn_t stmpe_gpio_irq(int irq, void *dev)
|
|
|
|
|
|
/*
|
|
|
* interrupt status register write has no effect on
|
|
|
- * 801 and 1801, bits are cleared when read.
|
|
|
- * Edge detect register is not present on 801 and 1801
|
|
|
+ * 801/1801/1600, bits are cleared when read.
|
|
|
+ * Edge detect register is not present on 801/1600/1801
|
|
|
*/
|
|
|
- if (stmpe->partnum != STMPE801 || stmpe->partnum != STMPE1801) {
|
|
|
+ if (stmpe->partnum != STMPE801 || stmpe->partnum != STMPE1600 ||
|
|
|
+ stmpe->partnum != STMPE1801) {
|
|
|
stmpe_reg_write(stmpe, statmsbreg + i, status[i]);
|
|
|
stmpe_reg_write(stmpe,
|
|
|
stmpe->regs[STMPE_IDX_GPEDR_LSB + i],
|