Added shape_matching package with skeleton shape_matcher node.