Added basic motor controller code

Setting of input and output pins for each motor has been collected in a single
place.

This code has not been tested, but represents the basic logic behind making the
wheels turn.

Signed-off-by: Morten Hustveit <morten.hustveit@gmail.com>