FEATURE: incorporated the sonar sensor and servo