Added roll, pitch dynamics, but there is an instability