Towards Building Autonomy And Intelligence For Surgical Robotic Systems Using Trajectory Optimization, Stochastic Estimation, Vision-Based Control, And Machine Learning Algorithms