Remove unused servo lib. Localize some vars and pass pointers for others.