Set result vector to zero by default.
Use noalias in StaticEnvCollisionConstr and SelfCollisionConstr.