added new features to check servo on and power on
Merge pull request #222 from irvs/issue221

added new features to check servo on and power on