successfully tested on mocap system -- minor changes