Constraint-Consistent Control of Task-Based and Kinematic RCM Constraints for Surgical Robots