Add robot driving test program