Add capsule shape and collision normal lookup