[HARDWARE][SERVO_MODULE] Update schemating & routing