Code plus propre, fonctions get_robot_2d et optimisation sin/cos à débugger