[fix] update computing of position of grah for Aruco