Design, Modeling, and Control of Minimally Invasive Robotic Surgical Systems with Integrated Sensors