fixed two bugs
Merge branch 'devel/crpc' of https://github.com/hubo/hubo-motion-rt into devel/crpc