[main_ai;main_prop] Fixes position control loop & Initialization of main robot