Unbreak touch for more people
While touch was working for some it permanently failed for others and some had mixed success. We were looking at the wrong config registers, fix this.
This also makes us use the identical code sent upstream (which was correct from the beginning).
Edited by Guido Gunther