Vision Based Surgical Tool Tracking and Force Estimation with Robot Kinematics Prior