Add a test for tasks::qp::MultiRobotTransformTask.
Fix some bad computation in tasks::qp::MultiRobotTransformTask.