Thread for moving the arm, adapted for DHE in branch master. Comming with test function. Need implementing base postures, management of fails