Merge pull request #67 from twiniars/master

hi communication debug removed
hi and kinematic fix