Updated FoamAllocator and GripperPoseEstimator