Fix https://github.com/start-jsk/rtshell_core/issues/16