xiaomi-sm8450/android_kernel_xiaomi_sm8450
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

gpio: stmpe: Fix edge and rising/falling edge detection

Browse Source 
By cross-checking STMPE 610/801/811/1601/2401/2403 datasheets,
it appears that edge detection and rising/falling edge detection
is not supported by all STMPE variant:

           GPIO              GPIO
      Edge detection     rising/falling
                         edge detection
 610 |      X        |         X       |
 801 |               |                 |
 811 |      X        |         X       |
1600 |               |                 |
1601 |      X        |         X       |
1801 |               |         X       |
2401 |      X        |         X       |
2403 |      X        |         X       |

Rework stmpe_dbg_show_one() and stmpe_gpio_irq to correctly
take these cases into account.

Signed-off-by: Patrice Chotard <patrice.chotard@st.com>
Reviewed-by: Linus Walleij <linus.walleij@linaro.org>
Signed-off-by: Lee Jones <lee.jones@linaro.org>
This commit is contained in:
Patrice Chotard
2016-08-10 09:39:08 +02:00
committed by Lee Jones
parent c4dd1ba355
commit 287849cb38
1 changed files with 60 additions and 25 deletions
Download Patch File Download Diff File Expand all files Collapse all files

63
drivers/gpio/gpio-stmpe.c
View File

@@ -247,19 +247,44 @@ static void stmpe_dbg_show_one(struct seq_file *s,
gpio, label ?: "(none)", gpio, label ?: "(none)",
val ? "hi" : "lo"); val ? "hi" : "lo");
} else { } else {
u8 edge_det_reg = stmpe->regs[STMPE_IDX_GPEDR_MSB] + num_banks - 1 - (offset / 8); u8 edge_det_reg;
u8 rise_reg = stmpe->regs[STMPE_IDX_GPRER_LSB] - (offset / 8); u8 rise_reg;
u8 fall_reg = stmpe->regs[STMPE_IDX_GPFER_LSB] - (offset / 8); u8 fall_reg;
u8 irqen_reg = stmpe->regs[STMPE_IDX_IEGPIOR_LSB] - (offset / 8); u8 irqen_reg;
bool edge_det;
bool rise; char *edge_det_values[] = {"edge-inactive",
bool fall; "edge-asserted",
"not-supported"};
char *rise_values[] = {"no-rising-edge-detection",
"rising-edge-detection",
"not-supported"};
char *fall_values[] = {"no-falling-edge-detection",
"falling-edge-detection",
"not-supported"};
#define NOT_SUPPORTED_IDX 2
u8 edge_det = NOT_SUPPORTED_IDX;
u8 rise = NOT_SUPPORTED_IDX;
u8 fall = NOT_SUPPORTED_IDX;
bool irqen; bool irqen;
switch (stmpe->partnum) {
case STMPE610:
case STMPE811:
case STMPE1601:
case STMPE2401:
case STMPE2403:
edge_det_reg = stmpe->regs[STMPE_IDX_GPEDR_MSB] +
num_banks - 1 - (offset / 8);
ret = stmpe_reg_read(stmpe, edge_det_reg); ret = stmpe_reg_read(stmpe, edge_det_reg);
if (ret < 0) if (ret < 0)
return; return;
edge_det = !!(ret & mask); edge_det = !!(ret & mask);
case STMPE1801:
rise_reg = stmpe->regs[STMPE_IDX_GPRER_LSB] -
(offset / 8);
fall_reg = stmpe->regs[STMPE_IDX_GPFER_LSB] -
(offset / 8);
ret = stmpe_reg_read(stmpe, rise_reg); ret = stmpe_reg_read(stmpe, rise_reg);
if (ret < 0) if (ret < 0)
return; return;
@@ -268,18 +293,28 @@ static void stmpe_dbg_show_one(struct seq_file *s,
if (ret < 0) if (ret < 0)
return; return;
fall = !!(ret & mask); fall = !!(ret & mask);
case STMPE801:
irqen_reg = stmpe->regs[STMPE_IDX_IEGPIOR_LSB] -
(offset / 8);
break;
default:
return;
}
ret = stmpe_reg_read(stmpe, irqen_reg); ret = stmpe_reg_read(stmpe, irqen_reg);
if (ret < 0) if (ret < 0)
return; return;
irqen = !!(ret & mask); irqen = !!(ret & mask);
seq_printf(s, " gpio-%-3d (%-20.20s) in %s %s %s%s%s", seq_printf(s, " gpio-%-3d (%-20.20s) in %s %13s %13s %25s %25s",
gpio, label ?: "(none)", gpio, label ?: "(none)",
val ? "hi" : "lo", val ? "hi" : "lo",
edge_det ? "edge-asserted" : "edge-inactive", edge_det_values[edge_det],
irqen ? "IRQ-enabled" : "", irqen ? "IRQ-enabled" : "IRQ-disabled",
rise ? " rising-edge-detection" : "", rise_values[rise],
fall ? " falling-edge-detection" : ""); fall_values[fall]);
} }
} }
@@ -338,8 +373,8 @@ static irqreturn_t stmpe_gpio_irq(int irq, void *dev)
stmpe_reg_write(stmpe, statmsbreg + i, status[i]); stmpe_reg_write(stmpe, statmsbreg + i, status[i]);
/* Edge detect register is not present on 801 */ /* Edge detect register is not present on 801 and 1801 */
if (stmpe->partnum != STMPE801) if (stmpe->partnum != STMPE801 || stmpe->partnum != STMPE1801)
stmpe_reg_write(stmpe, stmpe->regs[STMPE_IDX_GPEDR_MSB] stmpe_reg_write(stmpe, stmpe->regs[STMPE_IDX_GPEDR_MSB]
+ i, status[i]); + i, status[i]);
} }