distinguish FireAnt Uno and Due, implemented set servo XYZ