1 files changed, 6 insertions, 5 deletions

diff --git a/drivers/input/touchscreen/wm9713.c b/drivers/input/touchscreen/wm9713.c
index a7558015429b..7405353199d7 100644
--- a/drivers/input/touchscreen/wm9713.c
+++ b/drivers/input/touchscreen/wm9713.c
@@ -261,8 +261,9 @@ static int wm9713_poll_sample(struct wm97xx *wm, int adcsel, int *sample)
 {
         u16 dig1;
         int timeout = 5 * delay;
+        bool wants_pen = adcsel & WM97XX_PEN_DOWN;
 
-        if (!wm->pen_probably_down) {
+        if (wants_pen && !wm->pen_probably_down) {
                 u16 data = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
                 if (!(data & WM97XX_PEN_DOWN))
                         return RC_PENUP;
@@ -310,7 +311,7 @@ static int wm9713_poll_sample(struct wm97xx *wm, int adcsel, int *sample)
                 return RC_PENUP;
         }
 
-        if (!(*sample & WM97XX_PEN_DOWN)) {
+        if (wants_pen && !(*sample & WM97XX_PEN_DOWN)) {
                 wm->pen_probably_down = 0;
                 return RC_PENUP;
         }
@@ -400,14 +401,14 @@ static int wm9713_poll_touch(struct wm97xx *wm, struct wm97xx_data *data)
                 if (rc != RC_VALID)
                         return rc;
         } else {
-                rc = wm9713_poll_sample(wm, WM97XX_ADCSEL_X, &data->x);
+                rc = wm9713_poll_sample(wm, WM97XX_ADCSEL_X | WM97XX_PEN_DOWN, &data->x);
                 if (rc != RC_VALID)
                         return rc;
-                rc = wm9713_poll_sample(wm, WM97XX_ADCSEL_Y, &data->y);
+                rc = wm9713_poll_sample(wm, WM97XX_ADCSEL_Y | WM97XX_PEN_DOWN, &data->y);
                 if (rc != RC_VALID)
                         return rc;
                 if (pil) {
-                        rc = wm9713_poll_sample(wm, WM97XX_ADCSEL_PRES,
+                        rc = wm9713_poll_sample(wm, WM97XX_ADCSEL_PRES | WM97XX_PEN_DOWN,
                                                 &data->p);
                         if (rc != RC_VALID)
                                 return rc;