Added my first proper controller
Added configurable timestep (up/down to control)