Modification for DMocap project

This PR includes some modifications that we needed for DMocap.
Some bugs are fixed and some parameters are added to improve the interface of calib-hal.