From 5adb3455d1bffdeaf73313895388c37ead7291a6 Mon Sep 17 00:00:00 2001
From: Julian Sanin <sanin89julian@gmail.com>
Date: Sat, 11 Mar 2017 15:21:00 +0100
Subject: [PATCH] Fixed reversed order of evaluation of arguments in call to
 LineFollow::config

---
 src/ArduinoRobotMotorBoard.cpp | 15 +++++++++------
 1 file changed, 9 insertions(+), 6 deletions(-)

diff --git a/src/ArduinoRobotMotorBoard.cpp b/src/ArduinoRobotMotorBoard.cpp
index 1a68b77..7e5045d 100644
--- a/src/ArduinoRobotMotorBoard.cpp
+++ b/src/ArduinoRobotMotorBoard.cpp
@@ -73,6 +73,10 @@ void RobotMotorBoard::parseCommand(){
 	int value;
 	int speedL;
 	int speedR;
+	uint8_t KP;
+	uint8_t KD;
+	uint8_t robotSpeed;
+	uint8_t integrationTime;
 	if(this->messageIn.receiveData()){
 		//Serial.println("data received");
 		uint8_t command=messageIn.readByte();
@@ -119,12 +123,11 @@ void RobotMotorBoard::parseCommand(){
 				pauseMode(messageIn.readByte());//onOff state
 				break;
 			case COMMAND_LINE_FOLLOW_CONFIG:
-				LineFollow::config(
-					messageIn.readByte(),	//KP
-					messageIn.readByte(),	//KD
-					messageIn.readByte(),	//robotSpeed
-					messageIn.readByte()	//IntegrationTime
-				);
+				KP = messageIn.readByte();
+				KD = messageIn.readByte();
+				robotSpeed = messageIn.readByte();
+				integrationTime = messageIn.readByte();
+				LineFollow::config(KP, KD, robotSpeed, integrationTime);
 				break;
 		}
 	}