Adding test case from http://wiki.ros.org/gtest