testing programs

programs to test sensor and drive capability