add error msgs
fix joint_tf res bugs
improve handling of fr_j in joint_tf