def main(argv=None):
#Node
rospy.init_node('itech_mavros_local_pose_fusion', anonymous=True)
util.logBeginningInfo("mavros_local_pose_fusion")
Controller()
rospy.spin()
def main(argv=None):
#Node
rospy.init_node('itech_mavros_offboard', anonymous=True)
util.logBeginningInfo("mavros_offboard")
rate = rospy.Rate(20)
maxLinearSpeed, maxAngularSpeed, correctionMatrix = getArgs()
mavState = MavState(rate)
mavModel = MavModel(maxLinearSpeed, maxAngularSpeed, correctionMatrix)
mavController = MavController(mavModel)
if mavState.waitForFCUConnection():
while not rospy.is_shutdown():
mavController.publish()
rate.sleep()
def main(argv=None):
rospy.init_node('itech_marker_pose', anonymous=True)
util.logBeginningInfo("marker_pose")
try:
anchors = getArgs()
except ValueError as e:
rospy.logfatal(e.message)
anchors = None
if anchors is not None:
try:
PoseController(anchors)
rospy.spin()
except:
rospy.logfatal("Node has been terminated.")