Added get_history method. Fixed propagate error in calculating u_omega. Fixed wrapToPi syntax.