Write agent translation in extra bone in bvh

ROOT Position is added to bvh output.
No matrix decompostion neccesary