Legacy touchscreen: Fix B key issue

Patchset 2: Clean code

Change-Id: I089c1de787f12935ef382dabfe1babd3068ab753