It appears the wrong GPIO registers were used
Signed-off-by: NRoel Kluin <roel.kluin@gmail.com>
Signed-off-by: NPaulius Zaleckas <paulius.zaleckas@gmail.com>