| 51,6 → 51,7 |
|---|
| #include <inttypes.h> |
| #include "output.h" |
| #include "eeprom.h" |
| #include "timer0.h" |
| |
| // To access the DebugOut struct. |
| #include "uart0.h" |
| 115,3 → 116,60 |
|---|
| OUTPUT_SET(1, DebugOut.Digital[1] & DIGITAL_DEBUG_MASK); |
| } |
| } |
| |
| void beep(uint16_t millis) { |
| beepTime = millis; |
| } |
| |
| /* |
| * Make [numbeeps] beeps. |
| */ |
| void beepNumber(uint8_t numbeeps) { |
| while(numbeeps--) { |
| if(MKFlags & MKFLAG_MOTOR_RUN) return; //auf keinen Fall bei laufenden Motoren! |
| beep(100); // 0.1 second |
| delay_ms(250); // blocks 250 ms as pause to next beep, |
| // this will block the flight control loop, |
| // therefore do not use this function if motors are running |
| } |
| } |
| |
| /* |
| * Beep the R/C alarm signal |
| */ |
| void beepRCAlarm(void) { |
| if(beepModulation == 0xFFFF) { // If not already beeping an alarm signal (?) |
| beepTime = 15000; // 1.5 seconds |
| beepModulation = 0x0C00; |
| } |
| } |
| |
| /* |
| * Beep the I2C bus error signal |
| */ |
| void beepI2CAlarm(void) { |
| if((beepModulation == 0xFFFF) && (MKFlags & MKFLAG_MOTOR_RUN)) { |
| beepTime = 10000; // 1 second |
| beepModulation = 0x0080; |
| } |
| } |
| |
| /* |
| * Beep the battery low alarm signal |
| */ |
| void beepBatteryAlarm(void) { |
| beepModulation = 0x0300; |
| if(!beepTime) { |
| beepTime = 6000; // 0.6 seconds |
| } |
| } |
| |
| /* |
| * Beep the EEPROM checksum alarm |
| */ |
| void beepEEPROMAlarm(void) { |
| beepModulation = 0x0007; |
| if(!beepTime) { |
| beepTime = 6000; // 0.6 seconds |
| } |
| } |