Add turtleboteus rostest and update other tests

Add turtleboteus rostest and update other tests