Public Member Functions | |
| def | __init__ |
| def | build_trajectory |
| def | calc_dist |
| def | get_l_state |
| def | get_r_state |
| def | pose_frame_move |
| def | rot_l_wrist |
| def | rot_r_wrist |
| def | send_posture |
| def | send_traj |
| def | send_traj_to_contact |
| def | test |
| def | trans_l_hand |
| def | trans_r_hand |
Public Attributes | |
| curr_state | |
| SUBSCRIBERS ####. | |
| dist | |
| ft_hold_client | |
| ft_move_client | |
| Action Clients ####. | |
| ft_move_r_client | |
| goal_pub | |
| PUBLISHERS ####. | |
| posture_pub | |
| postures | |
| STATIC DATA ####. | |
| tf | |
| update_frame | |
| SERVICES ####. | |
Static Public Attributes | |
| tuple | dist = self.calc_dist(start,finish,arm=arm) |
| tuple | fracs = np.linspace(0, 1, steps) |
| tuple | new_q = transformations.quaternion_slerp(qs,qf,frac) |
| list | poses = [PoseStamped() for i in xrange(steps)] |
| list | qf |
| list | qs |
| list | start = self.curr_state[arm] |
| !!!!!!!!!!!! MUST BALANCE SPACING WITH SEND RATE IN 'SEND_TRAJ' FOR CONTROL OF VELOCITY !!!!!!!!!!!! | |
| tuple | steps = int(math.ceil(dist/space)) |
| tuple | xs = np.linspace(start.pose.position.x, finish.pose.position.x, steps) |
| tuple | ys = np.linspace(start.pose.position.y, finish.pose.position.y, steps) |
| tuple | zs = np.linspace(start.pose.position.z, finish.pose.position.z, steps) |
Definition at line 19 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.__init__ | ( | self, | |
tf = None |
|||
| ) |
Definition at line 20 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.build_trajectory | ( | self, | |
| finish, | |||
start = None, |
|||
arm = 0, |
|||
space = 0.001, |
|||
steps = None |
|||
| ) |
Definition at line 219 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.calc_dist | ( | self, | |
| ps1, | |||
ps2 = None, |
|||
arm = 0 |
|||
| ) |
Definition at line 266 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.get_l_state | ( | self, | |
| ps | |||
| ) |
Definition at line 94 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.get_r_state | ( | self, | |
| ps | |||
| ) |
Definition at line 97 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.pose_frame_move | ( | self, | |
| pose, | |||
| x, | |||
y = 0, |
|||
z = 0, |
|||
arm = 0 |
|||
| ) |
Definition at line 250 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.rot_l_wrist | ( | self, | |
| pt | |||
| ) |
Definition at line 110 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.rot_r_wrist | ( | self, | |
| pt | |||
| ) |
Definition at line 136 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.send_posture | ( | self, | |
posture = 'off', |
|||
arm = 0 |
|||
| ) |
Definition at line 187 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.send_traj | ( | self, | |
| poses, | |||
arm = 0 |
|||
| ) |
Definition at line 195 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.send_traj_to_contact | ( | self, | |
| poses, | |||
arm = 0 |
|||
| ) |
Definition at line 207 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.test | ( | self | ) |
Definition at line 295 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.trans_l_hand | ( | self, | |
| pt | |||
| ) |
Definition at line 162 of file jttask_utils.py.
| def jttask_utils.jt_task_utils.trans_r_hand | ( | self, | |
| pt | |||
| ) |
Definition at line 175 of file jttask_utils.py.
SUBSCRIBERS ####.
Definition at line 23 of file jttask_utils.py.
tuple jttask_utils.jt_task_utils::dist = self.calc_dist(start,finish,arm=arm) [static] |
Definition at line 224 of file jttask_utils.py.
Definition at line 250 of file jttask_utils.py.
tuple jttask_utils.jt_task_utils::fracs = np.linspace(0, 1, steps) [static] |
Definition at line 227 of file jttask_utils.py.
Definition at line 22 of file jttask_utils.py.
Action Clients ####.
Definition at line 22 of file jttask_utils.py.
Definition at line 22 of file jttask_utils.py.
PUBLISHERS ####.
Definition at line 24 of file jttask_utils.py.
tuple jttask_utils.jt_task_utils::new_q = transformations.quaternion_slerp(qs,qf,frac) [static] |
Definition at line 244 of file jttask_utils.py.
list jttask_utils.jt_task_utils::poses = [PoseStamped() for i in xrange(steps)] [static] |
Definition at line 230 of file jttask_utils.py.
Definition at line 24 of file jttask_utils.py.
STATIC DATA ####.
Definition at line 25 of file jttask_utils.py.
list jttask_utils.jt_task_utils::qf [static] |
[finish.pose.orientation.x, finish.pose.orientation.y,
finish.pose.orientation.z, finish.pose.orientation.w]
Definition at line 237 of file jttask_utils.py.
list jttask_utils.jt_task_utils::qs [static] |
[start.pose.orientation.x, start.pose.orientation.y,
start.pose.orientation.z, start.pose.orientation.w]
Definition at line 235 of file jttask_utils.py.
list jttask_utils.jt_task_utils::start = self.curr_state[arm] [static] |
!!!!!!!!!!!! MUST BALANCE SPACING WITH SEND RATE IN 'SEND_TRAJ' FOR CONTROL OF VELOCITY !!!!!!!!!!!!
Definition at line 222 of file jttask_utils.py.
tuple jttask_utils.jt_task_utils::steps = int(math.ceil(dist/space)) [static] |
Definition at line 226 of file jttask_utils.py.
Definition at line 20 of file jttask_utils.py.
SERVICES ####.
Definition at line 21 of file jttask_utils.py.
tuple jttask_utils.jt_task_utils::xs = np.linspace(start.pose.position.x, finish.pose.position.x, steps) [static] |
Definition at line 231 of file jttask_utils.py.
tuple jttask_utils.jt_task_utils::ys = np.linspace(start.pose.position.y, finish.pose.position.y, steps) [static] |
Definition at line 232 of file jttask_utils.py.
tuple jttask_utils.jt_task_utils::zs = np.linspace(start.pose.position.z, finish.pose.position.z, steps) [static] |
Definition at line 233 of file jttask_utils.py.