Is there a quick way to speed up ICP in python using a cached KD-tree
Try using spatial.cKDTree, in my ICP implementation switching from KDTree to cKDTree 30 iterations went from ~160 seconds to ~50 seconds