Design and Implementation of Software Planning System for Dental Robot