BLDC/SERVO motor test

BLDC motor test
SERVO init.