1. Add Error Handle & report to supervisor code
2. R/L Turn start code bug fix
3. Add auto test mode