add arduino ESC32 test code