Surgical Manipulator Capable of Controlling a Surgical Instrument in Multiple Modes

A surgical manipulator for manipulating a surgical instrument and an energy applicator extending from the surgical instrument. The surgical manipulator further includes a switch and at least one controller configured to control operation of the surgical manipulator in a first operating mode or a second operating mode. The at least one controller is also configured to determine a commanded pose to which the energy applicator is advanced based on a summation of a plurality of input forces and torques and transition between the operating modes by adjusting the plurality of input forces and torques in response to actuation of the switch.