Merge pull request #71 from twiniars/master

hi fix and force sensor tst mode
ros indigo compatibility fix