Function supCapsule

Capsule support function

Vector!(float,3) supCapsule (
  Vector!(float,3) dir,
  float radius,
  float height
);