vibration motor func to be tested

Configuration.h

@@ -16,7 +16,8 @@
 /* Serial Options */
 #define BAUDRATE            115200
 #define PING                '1'
-#define MOTORPING           '2'
+#define MOTORPING_ON        '2'
+#define MOTORPING_OFF       '3'
 
 /* =================================== */
 /* Pin layout */

SerialCommunication.cpp

@@ -36,10 +36,11 @@ void SerialCommunication::Read_Update_Request() {
             update_request = false;
         }
 
-        if (serial_in == MOTORPING) {
+        if (serial_in == MOTORPING_ON) {
             motor_flag = true;
-        } else if (serial_in != MOTORPING) {
+        } else if (serial_in == MOTORPING_OFF) {
             motor_flag = false;
+        }
     }
 }
 

multisensoryarduino.ino

@@ -55,12 +55,18 @@ void loop() {
     if(DSwitch[1].Get_Val()) {
         digitalWrite(NSLEEP_PIN, HIGH);
     } else {
-        digitalwrite(NSLEEP_PIN, LOW);
+        digitalWrite(NSLEEP_PIN, LOW);
     }
 
     if (motor_flag) {
         VibeMotor.Drive_Motor();
         vibration_output = VibeMotor.Get_Amplitude();
+        Serial.println("driving motor");
+    } else {
+        VibeMotor.Set_Amplitude(0);
+        VibeMotor.Drive_Motor();
+        vibration_output = VibeMotor.Get_Amplitude();
+        Serial.println("stopping motor");
     }
 
     for (int j = 0 ; j < 3; j++) {