Motion planning in medicine: optimization and simulation algorithms for image-guided procedures. Ron Alterovitz, Ken Goldberg