Use surface frame in MultiRobotTransformTask.
Pre allocation jacobian matrix to avoid allocation during the computation.
Fix indentation.