change function convert of BodyDataNode

BodyDataNodeのconvert関数およびその周辺を変更しました。
Kinectが手元にないのでテストはしていません。
合宿(旅行?)で試せれば試してみてください。