nbv_sim/scripts/calibrate_roi.py

18 lines
310 B
Python
Raw Permalink Normal View History

2021-12-03 14:13:59 +01:00
#!/usr/bin/env python3
2021-12-03 11:11:57 +01:00
import numpy as np
import rospy
from robot_helpers.ros import tf
def main():
rospy.init_node("calibrate_roi")
tf.init()
T_base_roi = tf.lookup("panda_link0", "tag_0")
2021-12-03 11:49:50 +01:00
np.savetxt("cfg/hw/T_base_tag.txt", T_base_roi.as_matrix())
2021-12-03 11:11:57 +01:00
if __name__ == "__main__":
main()