Robot control: theory and applications