Optimized the serial printing of target numbers
Added a constant for the servo frequency
Added multi servo board logic
Added the servo movement logic