Fix Q and C computation in MultiRobotTransformTask.