Modeling, identification and control of robots