simulink code to controll a arm-cortex contoler for a robot