Question

我正在尝试调用一个节点执行一项操作，然后继续执行下一项操作。收到错误：引发rospy.exceptions.ROSException（“ rospy.init_node（）已使用不同的参数调用：” + str（_init_node_args））

如何停止第一个节点才能继续下一个节点？

我尝试使用rospy.signal_shutdown（'Quit'），但Hole程序停止了，不仅是我想要的节点。

#!/usr/bin/env python

import os
import sys
import rospy
import baxter_interface
import time

import argparse

from geometry_msgs.msg import (    PoseStamped,    Pose,    Point,        Quaternion,)
from std_msgs.msg import Header
from baxter_core_msgs.srv import (    SolvePositionIK,        SolvePositionIKRequest,)

def ik_test(limb):
    rospy.init_node("rsdk_ik_service_client", disable_signals=True)
    ns = "ExternalTools/" + limb + "/PositionKinematicsNode/IKService"
    iksvc = rospy.ServiceProxy(ns, SolvePositionIK)
    ikreq = SolvePositionIKRequest()
    hdr = Header(stamp=rospy.Time.now(), frame_id='base')

    poses = {
        'left': PoseStamped(
            header=hdr,
            pose=Pose(
                position=Point(
                    x=0.657579481614,
                    y=0.851981417433,
                    z=0.0388352386502,
                ),
                orientation=Quaternion(
                    x=-0.366894936773,
                    y=0.885980397775,
                    z=0.108155782462,
                    w=0.162162481772,
                ),
            ),
        ),
        'right': PoseStamped(
            header=hdr,
            pose=Pose(
                position=Point(
                x=0.692002,
                y=-0.360751,
                z=-0.05133,
                ),
                orientation=Quaternion(
                    x=-0.105882425658, 
                    y=0.9364525476, 
                    z=-0.0241838726041,
                    w=0.333557608721,
                ),
            ),
        ),
    }

    ikreq.pose_stamp.append(poses[limb])

    try:
        rospy.wait_for_service(ns, 5.0)
        resp = iksvc(ikreq)
    except (rospy.ServiceException, rospy.ROSException), e:
        rospy.logerr("Service call failed: %s" % (e,))
        return 1

    if (resp.isValid[0]):
        print("SUCCESS - Valid Joint Solution Found:")
        # Format solution into Limb API-compatible dictionary
        limb_joints = dict(zip(resp.joints[0].name,         resp.joints[0].position))
        print limb_joints
    else:
        print("INVALID POSE - No Valid Joint Solution Found.")

    return limb_joints

def open_gripper():
    rospy.init_node('Hello_Baxter')

    limb = baxter_interface.Limb('right')
    from baxter_interface import Gripper
    right_gripper = Gripper('right')
    joints_names=        ['right_e0','right_e1','right_s0','right_s1','right_w0','right_w1','right_w2']

    r=rospy.Rate(10) #10Hz
    r.sleep()

    baxter_interface.gripper.Gripper('right').open() #Open right gripper
    return 0


def main():

    arg_fmt = argparse.RawDescriptionHelpFormatter
    parser = argparse.ArgumentParser(formatter_class=arg_fmt,
                                 description=main.__doc__)
    parser.add_argument(
        '-l', '--limb', choices=['left', 'right'], required=True,
        help="the limb to test"
    )
    args = parser.parse_args(rospy.myargv()[1:])

    limb_joints=ik_test(args.limb)
    limb = baxter_interface.Limb('right')
    limb.move_to_joint_positions(limb_joints)

    open_gripper()

    return 0 #ik_test(args.limb)


if __name__ == '__main__':
    sys.exit(main())

我希望第一个节点关闭，而另一个节点要初始化，但是我得到上面的错误。

Answer 1

您似乎对使用ROS节点和python脚本的方式感到困惑。您的python脚本应为单个节点。在该节点上，您可以在不同时间创建和销毁不同的主题，服务和操作，但只能创建一个节点一次。

您应该在主要功能的开始处初始化一个，然后可以在需要时创建所需的不同服务和操作。

希望这会有所帮助。

如何两次调用rospy.init_node（）

1 个答案: