Bugfix in agentManager bvh: write num of channels, write end sites
Simulation writes out bvh motion data