using function to init
Punching holes now from ids, not lists
Servos added, controlled by serial commands now
Everything required and working in one file