add test code to check #287 problem

I'm afraid this will pass the travis since newer version of robot_model is already released in shadow-fixed.
@130s please check if #290 is valid with this PR