flip_all.py

Go to the documentation of this file.

#!/usr/bin/env python
#       
# License: BSD
#   https://raw.github.com/robotics-in-concert/rocon_multimaster/master/rocon_gateway_demos/LICENSE 
#

import roslib; roslib.load_manifest('rocon_gateway_demos')
import rospy
import rocon_gateway
import rocon_gateway_demos
from gateway_msgs.msg import *
from gateway_msgs.srv import *
import argparse
import sys

"""
  Tests a single flip rule.
  
  Usage:
    1 > roslaunch rocon_gateway_demos pirate_hub.launch
    2a> roslaunch rocon_gateway_demos pirate_gateway_tutorials.launch
    3a> roslaunch rocon_gateway_demos pirate_gateway.launch
    2b> rosrun rocon_gateway_demos flip_all.py
    2c> rosrun rocon_gateway_demos flip_all.py --cancel
"""

if __name__ == '__main__':

    parser = argparse.ArgumentParser(description='Flip all connections (unflip if using --cancel')
    #parser.add_argument("gateway", help="gateway string identifier", type=str)
    parser.add_argument('--cancel', action='store_true', help='cancel the flip')
    args = parser.parse_args()
    if args.cancel:
        action_text = "cancelling"
    else:
        action_text = "flipping"

    rospy.init_node('flip_all')

    try:
        gateway = rocon_gateway_demos.findFirstRemoteGateway()
    except rocon_gateway.GatewayError as e:
        rospy.logerr("Flip Test : %s, aborting."%(str(e)))
        sys.exit(1)
    
    flip_all = rospy.ServiceProxy('/gateway/flip_all',RemoteAll)
    req = RemoteAllRequest() 
    req.gateway = gateway
    req.cancel = args.cancel
    req.blacklist = []

    rospy.loginfo("Flip All : %s all [%s]."%(action_text,req.gateway)) 
    resp = flip_all(req)
    if resp.result != 0:
        rospy.logerr("Flip All : %s"%resp.error_message)