Adding arduino sketch for servo controll