add proportional open loop controller, BROKEN - WIP