Change Cartesian waypoint tolerance type to array

[marip8]

The Cartesian waypoint tolerance type (and associated functions/parameters) should probably be a fixed size array (size 6), rather than a vector of dynamic size since it represents [x, y, z, roll, pitch, yaw].

tesseract_planning/tesseract_command_language/include/tesseract_command_language/cartesian_waypoint.h

Lines 83 to 86 in bf691c0

	Eigen::VectorXd lower_tolerance_;
	/** @brief Distance above waypoint that is allowed. Should be size = 6. First 3 elements are dx, dy, dz. The last 3
	* elements are angle axis error allowed (Eigen::AngleAxisd.axis() * Eigen::AngleAxisd.angle())*/
	Eigen::VectorXd upper_tolerance_;