r2r_pick_point_prep Fix mexh path in main.rs Launch with: cargo run Open rviz with rviz2 Add the markers Get the relative teaching_marker pose