[testing] Add some unit-test for pioneer3dx robot

Cover issue #245
Don't link it with the build for moment, as it is completely broken.