Read the register values we wrote

The code was reading the input pin values, instead of the values we wrote to the output registers. In some cases, this caused reading back the wrong state (i.e. we're turning right when we're actually turning left).

Signed-off-by: Steve Conklin <sconklin@canonical.com>