add test code for fkanehiro/hrpsys_base/pull/297