 //#include "Servo.cpp"g_oDataMonster
 #include "DataMonster.cpp"
+#include "SensorModule.cpp"
 
 // Function Signatures
 void getSerialCommand();

  // else
  //  {
  // Control Robot
//  controlRobot();
  //  }

}

  //    g_poDataMonster->setPosture();

  // IF g_oSensorModule.foundPerson()
  g_poMySensorModule->update(); // getPersonsLocation(g_fX,g_fY,g_fZ);
  // g_poDataMonster->setMood(FOCUSED)
  // ELSE
  // [X,Y,Z] = g_oSensorModule.getNextDataPosture()
  // g_poDataMonster->setMood(CHILLING)
  g_fX = g_poMySensorModule->location[0];
  g_fY = g_poMySensorModule->location[1];
  g_fZ = g_poMySensorModule->location[2];
  g_poDataMonster->setPosture(g_fX,  g_fY,  g_fZ);
  Serial.print("X: ");
  Serial.print(g_fX);
  Serial.print(" Y: ");
  Serial.print(g_fY);
  Serial.print(" Z: ");
  Serial.println(g_fZ);


  //////////////
