add JointState::getPositionInParentFrame()
whitespace formatting
add constraints between child joints of same parent