Setup visual servo package and added stub code