fix and extend replicate optimization, and add the packet method though it is currently disabled
fix and extend replicate optimization, and add the packet method though it is currently disabled

robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen