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

  pinMode(g_iLed13, OUTPUT);     

  // Generate rand numbers
//  oRandNumGen = new Random();

  // Setup Servos
  //  g_poServo = new Servo(3);
  //  g_poServo->setPwmLimits(0, 255);

  g_poDataMonster = new DataMonster();

  //Initialize serial and wait for port to open:
  Serial.begin(9600); 

  //    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);


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