fix sphere-capsule collisions at the capsule caps
Adding StreamUtils for common debug output
Add penetration resolution helper for Hand class