F use hand calib

Does the ROS_ASSERT capture and out of bounds array here?