fixed rotation to point bug before checkpoint reached and modularize angles bug
and proximity bug