void initRobot() {
servo[rampLatch] = 20;
servo[platLatch] = 255;
ClearTimer(T1); //Clear timer 1 for checking to see how long the robot waits before starting
initDrivetrain();//Initialize systems
initElevator();
StartTask(ElevatorControlTask); //begin elevator control task
StartTask(SignalLight);
setMode(IDLE);
}
void cRenderObjs::init()
{
if(!m_bIsInit) {
m_bIsInit = true;
initPlane();
initCube();
initSphere();
initElevator();
initHuman();
}
}
int mainLoop(int passengerThreshold, int maxLevels, int maxWaiters, int maxPassengers, int elevatorSteps,int sleepMS, int doorTime){
int newPassenger = 1;
initElevator(maxLevels, maxPassengers, elevatorSteps, doorTime);
initPassengers(maxWaiters, maxPassengers, maxLevels);
while(running){
simulateStep();
newPassenger += (autoNew) ? 1 : 0;
if(newPassenger > passengerThreshold){
createRandom(1);
newPassenger = 1;
}
usleep(sleepMS * microToMilli);
}
return running; //should be "0"
}
