void startElevator () {
//Serial.println("Start Elevator");
halt = false;
currentDirection ? motorUp() : motorDown();
timeAtStarted = millis();
//Serial.println(timeAtStarted);
}
void returnToGround(){
currentFloor = EEPROM.read(1);
if (currentFloor != 0) {
doorClose();
for (int i = 0; i < EEPROM.read(1); ++i)
{
motorDown();
currentFloor--;
delay(TIME_BETWEEN_FLOORS);
}
EEPROM.write(1,0);
}
}
void TYKinect :: RegisterKey(int key){
switch(opMode){
case OPMODE_NORMAL:
if(key==27){
Stop();
}else if(key == 'm'){
opMode = OPMODE_SELECT;
}else if(key == 'q'){
motorUp();
}else if(key == 'w'){
motorDown();
}else if(key == 'l'){
setLed(0);
}else if(key == 's'){
CreateDirectory("output",NULL);
SaveImages();
}
break;
case OPMODE_CROP:
if(key==27){
Stop();
}else if(key == 'm'){
opMode = OPMODE_SELECT;
}else if(key == 'A'){
if((cropL-2) >= 0) cropL -= 2;
}else if(key == 'a'){
if((cropL+2) < cropR) cropL += 2;
}else if(key == 'D'){
if((cropR+2) <= (unsigned)(width - 1)) cropR += 2;
}else if(key == 'd'){
if((cropR-2) > cropL) cropR -= 2;
}else if(key == 'W'){
if((cropT-2) >= 0) cropT -= 2;
}else if(key == 'w'){
if((cropT+2) < cropB) cropT += 2;
}else if(key == 'S'){
if((cropB+2) <= (unsigned)(height - 1)) cropB += 2;
}else if(key == 's'){
if((cropB-2) > cropT) cropB -= 2;
}else if(key == 'Z'){
if((cropN-10) > 0) cropN -= 10;
}else if(key == 'z'){
if((cropN+10) < cropF) cropN += 10;
}else if(key == 'X'){
if((cropF+10) < 10000) cropF += 10;
}else if(key == 'x'){
if((cropF-10) > cropN) cropF -= 10;
}
if(key == 'w' || key == 'a' || key == 's' || key == 'd' || key == 'z' || key == 'x' ||
key == 'W' || key == 'A' || key == 'S' || key == 'D' || key == 'Z' || key == 'X' )
printf("Crop(N, F, L, R, T, B)=(%d,%d,%d,%d,%d,%d)\n",cropN,cropF,cropL,cropR,cropT,cropB);
break;
case OPMODE_SELECT:
if(key == 'n') opMode = OPMODE_NORMAL;
else if(key == 'c') opMode = OPMODE_CROP;
break;
}
}
