Generalized penetration depth for penalty-based six-degree-of-freedom haptic rendering