Add test go pos new

THis is rewrited version of https://github.com/start-jsk/rtmros_common/pull/557