Int value servo control and program flow

check post for respnse.