add test python script for go-pos 

add test_go_pos function to test-samplerobot.py for testing go-pos
usage:
```
rostest hrpsys_ros_bridge samplerobot.test
```