added compute cartesian path method - not used for now
added test mode option
modified parameters for planner