摘要

In this paper, a new method is proposed for controlling the motors of ICaSbot (IUST Cable Suspended Robot), which is a modified version of crane aiming to object handling in industrial environments. In order to provide more accurate tracking, torque and speed of the motors are controlled simultaneously, using inverse kinematics and inverse dynamics of the robot. The equations of the motors are evaluated as a look-up table by conducting some special experimental tests and calibrations, while their data sheets and motor parameters are not available. The required feedforward signal of the motors are estimated by the aid of inverse dynamics of the robot, while its errors are compensated by the aid of PID controller on the speed and torque of the motor. As a result, the required (Pulse Width Modulation) PWM of the motor is exerted to produce a desired angular velocity, while a specific amount of torque is applied on the motors. Not only the voltage of the motors is controlled using the mentioned PWM, but also the current is improved using the feedback control of the torques. PID gains are optimized using Ziegler-Nichols method. By the aid of the mentioned combination of feedforward and feedback controlling terms of the motor speed and torque, the desired trajectory is tracked with the highest possible accuracy. Efficiency of the proposed method is eventually proved by comparing the experimental tests with simulation results.

  • 出版日期2013-10