clean up of controller and added multiple inports and addition of ffw's
tested controller additions (ffw ports and multiple inports) on amigo
added check in configurehook
Merge pull request #9 from tue-robotics/controllertest

Controllertest