add test main part in servo_2BBMG.py