Add servo driving library