I/P : , ..and..
O/P : where is the i-th joint acceleration, a is the linear tool acceleration and is the angular tool acceleration.