def update_position(self, delta_time): """update lat/lon/alt from position""" bearing = math.degrees(math.atan2(self.position.y, self.position.x)) distance = math.sqrt(self.position.x ** 2 + self.position.y ** 2) (self.latitude, self.longitude) = util.gps_newpos(self.home_latitude, self.home_longitude, bearing, distance) self.altitude = self.home_altitude - self.position.z velocity_body = self.dcm.transposed() * self.velocity self.accelerometer = self.accel_body.copy()
def update_position(self, delta_time): '''update lat/lon/alt from position''' bearing = math.degrees(math.atan2(self.position.y, self.position.x)) distance = math.sqrt(self.position.x**2 + self.position.y**2) (self.latitude, self.longitude) = util.gps_newpos(self.home_latitude, self.home_longitude, bearing, distance) self.altitude = self.home_altitude - self.position.z velocity_body = self.dcm.transposed() * self.velocity self.accelerometer = self.accel_body.copy()