fixed major bug for PATH_TURN_RIGHT and tuned parameters for nicer performance