equation of angular position equation is wrongly given in physics_sim.py:
It is given as
angles = self.pose[3:] + self.angular_v self.dt + 0.5 self.angular_accels self.angular_accels self.dt
However it should be
angles = self.pose[3:] + self.angular_v self.dt + 0.5 self.angular_accels * self.dt**2
equation of angular position equation is wrongly given in physics_sim.py: It is given as angles = self.pose[3:] + self.angular_v self.dt + 0.5 self.angular_accels self.angular_accels self.dt However it should be angles = self.pose[3:] + self.angular_v self.dt + 0.5 self.angular_accels * self.dt**2