A constrained optimization approach to virtual fixtures for multi-handed tasks