Tool Path Planning with Confined Scallop Height Error Using Optimal Connected Fermat Spirals