Still a lot of work to be done, I need to smooth out the servos and adjust some of the start and end points. But here is the function the head will have.
No download links available.