collision scheme based on capsules, almost done