More debug info. Disable costFactorMap calculation. Modify ORCA