Rapid Planning Method for Robot Assited Minimally Invasive Surgery