In this paper a new method for estimating the end-effector pose in the cable-driven parallel robots (CDPRs) with elastic cables is introduced. In many applications, the end-effector pose is determined considering the direct kinematic and motor rotations obtained from encoders. Since the cable flexibility in the CDPRs leads to the end-effector vibration, the fast dynamic movement, caused by the cable flexibility, cannot be observed using only motor rotation. The issues concerned with the other common sensors, include expensiveness, inaccuracy for vibration measurement and requiring precise cable model. In this study, an inertial measurement unit (IMU), mounted on the end-effector and consisted of accelerometer and gyro sensors, is employed to detect the vibrational states. Therefore, motor encoders observe the slow dynamic movement whereas IMU detects the fast dynamic movement of the end-effector. Since the measurements, particularly using IMU, include noise and bias, the Kalman approach is employed for the data fusion of two measurement systems. Employing the contextual information, the estimations obtained by the encoders, IMU and Kalman estimator are fused based on the degree of trust to each data. The Kalman filter (KF) is typically applied to linear or linearized systems. Therefore, using the Feedback Linearization (FL) control law the slow error dynamic of the system is linearized. Considering the rigid model basis of the controller, the necessary condition ensuring the flexible system stability is presented employing the Lyapunov stability criterion. In the first simulation, it is shown that using KF on the feedback data, the system divergence in the presence of measurement noise is prevented. In the second simulation, the effectiveness of the proposed data fusion approach in precise estimation of the end-effector pose is demonstrated. It is shown that the mean estimation error using the encoder-based method with respect to the data fusion approach is 1.6 and 12.7 for the position and angular vibration, respectively. Finally, an experimental test is provided to demonstrate the effectiveness of the proposed method.
Read full abstract