Added the supporting sponge to the RAVE environment in order to check for collisions while piercing.
Cleaned up piercing (now using the second method to check for closest possible piercing trajectory to normal insertion). Changed the way transforms are tested (can do so without needing to close the node, and can also view multiple transforms at once ). Changes for sponge in openrave.