def get_vector_speed(__): temp = cos(radian(__.aV)) * __.speed vx = cos(radian(__.aH)) * temp if -1.0e-5 < vx < 1.0e-5: vx = 0 vy = -sin(radian(__.aH)) * temp if -1.0e-5 < vy < 1.0e-5: vy = 0 vz = -sin(radian(__.aV)) * __.speed if -1.0e-5 < vz < 1.0e-5: vz = 0 return vx, vy, vz
def get_coords_motor(__): temp = cos(radian(__.aV)) return (__.x - cos(radian(__.aH)) * temp * __.eX, __.y + sin(radian(__.aH)) * temp * __.eY, __.z + sin(radian(__.aV)) * 1.3 * __.eZ)