Servomotor controller for ATMega16