Pose_list.py

from cal import calib_target_ he_target_

# [x, y, z, qx, qy, qz, qw]

# Picking up calibration target
grab_target = []
grab_target.append([-5.27590871e-01, -7.52297699e-01, 6.54528260e-01, 2.86723282e-02, 7.70514786e-01, -6.36554416e-03, 6.36745155e-01])
grab_target.append([-4.08078909e-01, -7.52294898e-01, 6.54507637e-01, 2.86584217e-02, 7.70526707e-01, -6.37562852e-03, 6.36731207e-01])
grab_target.append([-4.08080220e-01, -7.52288520e-01, 6.78982735e-01, 2.86867991e-02, 7.70524502e-01, -6.35420671e-03, 6.36732817e-01])

# Lift the target
lift_target = []
lift_target.append([-0.408085, -0.752281, 1.00973, 0.0286753, 0.770531, -0.00634497, 0.636725])

# Postion arm for calibration
calib_target = calib_target_

# Postion arm for hand-eye calibration
he_target = he_target_

# Dropping target
drop_target = []
drop_target.append([-4.08080220e-01, -7.52288520e-01, 6.78982735e-01, 2.86867991e-02, 7.70524502e-01, -6.35420671e-03, 6.36732817e-01])
drop_target.append([-4.08078909e-01, -7.52294898e-01, 6.54507637e-01, 2.86584217e-02, 7.70526707e-01, -6.37562852e-03, 6.36731207e-01])
drop_target.append([-5.27590871e-01, -7.52297699e-01, 6.54528260e-01, 2.86723282e-02, 7.70514786e-01, -6.36554416e-03, 6.36745155e-01])