Added sphere-capsule routines

Hi,

I've added sphere-capsule routines including some tests as the code that comes with fcl does not return proper results.

Regards,
Martin