Fix hrpsys sample and add unittest euslisp

Fix hrpsys sample and add unittest euslisp file.
Currently not tested in catkin_make test.