Updated ESC test, motors now work!