Fixed directions and motors in debug
Fix init for grabbot arduino code