Fix initializing parameters order of PID