Add robot testing environment and first robot test