Update nRF_RobotControl.ino

nRF_BTLE_ReceiveData/nRF_RobotControl/nRF_RobotControl.ino

@@ -14,12 +14,12 @@
 Servo rightWheel;
 Servo leftWheel;
 
-RF24 radio(9,10);   // Create RF24 object to work with the RF24 library.
+RF24 radio(9, 10);  // Create RF24 object to work with the RF24 library.
 BTLE btle(&radio);  // Create BTLE object to work with the BTLE library.
 
 /* Replace! "CustomName" to the name of your device. Password - maximum length (14)! characters.
    It's for recognizing the correct data packets. */
-#define PASSWORD "Galaxy A70"
+#define PASSWORD "FBI van"
 
 /* Define functions used for the robot to control */
 /* Stop the robot */
@@ -28,24 +28,24 @@ void setWheelsStop() {
   leftWheel.writeMicroseconds(1500);
 }
 /* Drive forward */
-void setWheelsForward(){
-  rightWheel.write(1300);
-  leftWheel.write(1700);
+void setWheelsForward() {
+  rightWheel.writeMicroseconds(1300);
+  leftWheel.writeMicroseconds(1700);
 }
 /* Drive right */
-void setWheelsRight(){
-  rightWheel.write(1700);
-  leftWheel.write(1700);
+void setWheelsRight() {
+  rightWheel.writeMicroseconds(1700);
+  leftWheel.writeMicroseconds(1700);
 }
 /* Drive left */
-void setWheelsLeft(){
-  rightWheel.write(1300);
-  leftWheel.write(1300);
+void setWheelsLeft() {
+  rightWheel.writeMicroseconds(1300);
+  leftWheel.writeMicroseconds(1300);
 }
 /* Drive backward */
-void setWheelsBackward(){
-  rightWheel.write(1700);
-  leftWheel.write(1300);
+void setWheelsBackward() {
+  rightWheel.writeMicroseconds(1700);
+  leftWheel.writeMicroseconds(1300);
 }
 
 void setup() {
@@ -70,9 +70,9 @@ void loop() {
   if (btle.listen()) {
     // Serial.print("Got payload: ");  // If data is received, print "Got payload: "
     /* Store the received data into the buffer */
-    for (uint8_t i = 2; i < (btle.buffer.pl_size)-6; i++) {
+    for (uint8_t i = 2; i < (btle.buffer.pl_size) - 6; i++) {
       str += (char (btle.buffer.payload[i]));
-        // Serial.print(btle.buffer.payload[i],HEX); Serial.print(" ");  // To receive data in HEX format
+      // Serial.print(btle.buffer.payload[i], HEX); Serial.print(" "); // To receive data in HEX format
       // Serial.print(char (btle.buffer.payload[i])); Serial.print(" ");  // To receive data in char format
     }
 
@@ -101,12 +101,12 @@ void loop() {
         setWheelsForward();
         delay(100);
       }
-    }
-    else  {
+    } else  {
       Serial.println("STOP");
       setWheelsStop();
       delay(100);
     }
+
   }
 
   /* Hop channels through 37-39 to scan for data transmissions */