Hi @holdred. Sorry for the late reply. 
The current problem is...
You can use the ServoTimer2 library and success to servo operation with test sketch.
But if you attach it into the code you actually want to use then some servo operation instructions don't work.
Is it right?
I'm sorry to trouble you many times, but could you please post the latest version of the code?