|
@ -1,30 +1,7 @@ |
|
|
#! /usr/bin/env python |
|
|
#! /usr/bin/env python |
|
|
from __future__ import print_function |
|
|
from __future__ import print_function |
|
|
|
|
|
|
|
|
import yaml |
|
|
|
|
|
import numpy as np |
|
|
import numpy as np |
|
|
import threading |
|
|
|
|
|
import stretch_body.robot as rb |
|
|
|
|
|
from stretch_body.hello_utils import ThreadServiceExit |
|
|
|
|
|
|
|
|
|
|
|
import tf2_ros |
|
|
|
|
|
import tf_conversions |
|
|
|
|
|
|
|
|
|
|
|
import rospy |
|
|
|
|
|
from geometry_msgs.msg import Quaternion |
|
|
|
|
|
from geometry_msgs.msg import Twist |
|
|
|
|
|
from geometry_msgs.msg import TransformStamped |
|
|
|
|
|
|
|
|
|
|
|
import actionlib |
|
|
|
|
|
from control_msgs.msg import FollowJointTrajectoryAction |
|
|
|
|
|
from control_msgs.msg import FollowJointTrajectoryResult |
|
|
|
|
|
|
|
|
|
|
|
from std_srvs.srv import Trigger, TriggerResponse |
|
|
|
|
|
|
|
|
|
|
|
from nav_msgs.msg import Odometry |
|
|
|
|
|
from sensor_msgs.msg import JointState, Imu, MagneticField |
|
|
|
|
|
from std_msgs.msg import Header |
|
|
|
|
|
|
|
|
|
|
|
import hello_helpers.hello_misc as hm |
|
|
import hello_helpers.hello_misc as hm |
|
|
from hello_helpers.gripper_conversion import GripperConversion |
|
|
from hello_helpers.gripper_conversion import GripperConversion |
|
|
|
|
|
|
|
|