Joint based inversion control for trajectory tracking of the mobile servicing system