I've been cobbling together crappy things to do similar things for robot kinematics a lot, this looks awesome, thank you!