When passing the root frame, getRigidlyConnectedParentLinkModel() returns a nullptr for robot_link, causing a segfault. Actually, we don't need to use that method at all. We just need to find the robot_link of an associated body.
fallbacks and verification.
leaves us a place to put free helper functions