in the sequence if self._base is not None: Rb = t2r(self.base.A).T w = Rb @ wd wd = Rb @ wdd vd = Rb @ gravity wdd is not defined