A method includes using at least one processor to detect that a tool coupled to an end effector of a robot having multiple joints is contacting a surface. The robot includes multiple joint motors configured to control multiple motions of the multiple joints. One or more control systems are configured to control each of the joint motors in a joint position mode. The method also includes identifying, via the at least one processor, a first joint of the multiple joints in response to detecting that the tool is contacting the surface. The method also includes sending, via the at least one processor, a command to at least one of the one or more control systems associated with a first joint motor of the multiple joint motors that corresponds to the first joint. The command is configured to cause the at least one of the one or more control systems to operate in a torque mode. The method also includes sending, via the at least one processor, a joint torque value to the at least one of the one or more control systems. The at least one of the one or more control systems is configured to cause the first joint to apply the joint torque value via the first joint motor.