A GEOMETRY-BASED MOTION PLANNER FOR DIRECT MACHINING AND CONTROL