Merge pull request #202 from irvs/issue200

add sp5_2's module for grasp test
fix a bug check vector.empty()