Added possible code for mutli-servo control

still must be tested and modified to work with MD.3.0.1