com test and move servo with mbed