fixed eigen quadrotor bug. single integrator and holonomic still not working right