Fixed problem with different GPIO pins

Signed-off-by: Tim Sanwald <sanwald.tim@googlemail.com>