Adding more Arduino Lathe function - "Chamfer" turns into complex Profiling

With the success of threading with the Arduino I quickly moved onto my next desired function which was to add a routine which could automatically take a simple chamfer on the end of the stock.  Very soon I realized that this routine should include a simple taper.... at this time I'm thinking "Great, this is new function which can be easily accomplished without the need for a cross slide or dogs to hold between centers" - what great added value here.  It didn't take me too long in creating this program that I realized what I was creating was simply point-to-point motion performed repeatedly and controlled with varying depth of cut.... and this is where my simple addition to the program ballooned up to a function 3x more difficult to create than the threading routine.  The outcome is a function with accept ANY number of operator input points with roughing and finishing depth of cuts and automatically cuts the profile.  

Under construction still..... Video will be posted soon - program works well but still working on a couple bugs..... 
And here is the supporting video.