2D simulations in new simulation framework, mode1 only

mode2 switching isn't working (can't calculate quadrotor trajectory
directly here anymore), no storing of desired angles, animation not
working