void MUSIC_Play(u16 music) { #if HAS_EXTENDED_AUDIO // Play audio for switch if ( music > MUSIC_TOTAL ) { if (AUDIO_VoiceAvailable()) AUDIO_AddQueue(music); return; } playback_device = AUDDEV_UNDEF; #endif vibrate = 1; // Haptic sensor set to on as default /* NOTE: We need to do all this even if volume is zero, because the haptic sensor may be enabled */ if (MUSIC_GetSound(music)) return; #if HAS_EXTENDED_AUDIO if ( !(playback_device == AUDDEV_BUZZER) ) { if ( AUDIO_VoiceAvailable() && AUDIO_AddQueue(music) ) { if ((playback_device == AUDDEV_EXTAUDIO) || (playback_device == AUDDEV_UNDEF)) { Volume = 0; return; } } } #endif if(! num_notes) return; SOUND_SetFrequency(note_map[Notes[0].note].note, Volume); SOUND_Start((u16)Notes[0].duration * 10, next_note_cb, vibrate); }
void EventLoop() { CLOCK_ResetWatchdog(); #ifdef HEAP_DEBUG static int heap = 0; int h = _sbrk_r(NULL, 0); if(h > heap) { printf("heap: %x\n", h); heap = h; } #endif #ifdef TIMING_DEBUG debug_timing(0, 0); #endif priority_ready &= ~(1 << MEDIUM_PRIORITY); #if !HAS_HARD_POWER_OFF if(PWR_CheckPowerSwitch()) { if(! (BATTERY_Check() & BATTERY_CRITICAL)) { PAGE_Test(); CONFIG_SaveModelIfNeeded(); CONFIG_SaveTxIfNeeded(); } if(Transmitter.music_shutdown) { #if HAS_EXTENDED_AUDIO if(AUDIO_VoiceAvailable()) { MUSIC_Play(MUSIC_SHUTDOWN); while (CLOCK_getms() < audio_queue_time) { // Wait for voice to finished CLOCK_ResetWatchdog(); } } else { #else { // We wait ~1sec for shutdown buzzer music finished unsigned int time; MUSIC_Play(MUSIC_SHUTDOWN); time = CLOCK_getms()+700; while (CLOCK_getms() < time) { CLOCK_ResetWatchdog(); } #endif } } PWR_Shutdown(); } #endif BUTTON_Handler(); TOUCH_Handler(); INPUT_CheckChanges(); if (priority_ready & (1 << LOW_PRIORITY)) { priority_ready &= ~(1 << LOW_PRIORITY); PAGE_Event(); PROTOCOL_CheckDialogs(); TIMER_Update(); TELEMETRY_Alarm(); BATTERY_Check(); AUTODIMMER_Update(); #if HAS_DATALOG DATALOG_Update(); #endif #if HAS_VIDEO VIDEO_Update(); #endif #if HAS_EXTENDED_AUDIO AUDIO_CheckQueue(); #endif GUI_RefreshScreen(); #if HAS_HARD_POWER_OFF if (PAGE_ModelDoneEditing()) CONFIG_SaveModelIfNeeded(); CONFIG_SaveTxIfNeeded(); #endif } #ifdef TIMING_DEBUG debug_timing(0, 1); #endif } void TOUCH_Handler() { if(! HAS_TOUCH) return; u32 pen_down=0; static u32 pen_down_last=0; static u32 pen_down_long_at=0; struct touch t; if(SPITouch_IRQ()) { pen_down=1; t=SPITouch_GetCoords(); if (! pen_down_last) pen_down_long_at=CLOCK_getms()+500; } else { pen_down=0; } if(pen_down && (!pen_down_last)) { AUTODIMMER_Check(); GUI_CheckTouch(&t, 0); } if(!pen_down && pen_down_last) { GUI_TouchRelease(); } if(pen_down && pen_down_last) { if(CLOCK_getms()>pen_down_long_at) { GUI_CheckTouch(&t, 1); pen_down_long_at += 100; } } pen_down_last=pen_down; } #if HAS_VIDEO void VIDEO_Update() { static u8 video_enable = 0; static u32 check_standard_ms = 0; // Check if Video is turn on int enabled = MIXER_SourceAsBoolean(Model.videosrc); if (enabled != video_enable) { VIDEO_Enable(enabled); video_enable = enabled; if (enabled) { VIDEO_SetChannel(Model.videoch); VIDEO_Contrast(Model.video_contrast); VIDEO_Brightness(Model.video_brightness); check_standard_ms = CLOCK_getms() + 3000; } else check_standard_ms = 0; } if(video_enable && check_standard_ms > 0 && check_standard_ms < CLOCK_getms()) { u8 video_standard_current = VIDEO_GetStandard(); if((video_standard_current > 0) && (video_standard_current < 8)) { VIDEO_SetStandard(video_standard_current); check_standard_ms = 0; } else { check_standard_ms = CLOCK_getms() + 3000; } } if(video_enable) AUTODIMMER_Check(); } #endif //HAS_VIDEO #ifdef TIMING_DEBUG void debug_timing(u32 type, int startend) { static u32 last_time[2][100]; static u32 loop_time[4][101]; static u32 loop_pos[4] = {-1, -1, -1, -1}; static u32 max_last[2]; static u32 max_loop[4]; static int save_priority; if (type == 0) { if (! startend) save_priority = priority_ready; if (save_priority & (1 << MEDIUM_PRIORITY)) debug_timing(2, startend); if (save_priority & (1 << LOW_PRIORITY)) debug_timing(1, startend); return; } type--; if (! startend) { u32 t = CLOCK_getms(); loop_pos[type] = (loop_pos[type] + 1) % 100; if (type < 2) { last_time[type][loop_pos[type]] = t; if (t - last_time[type][(loop_pos[type] + 99) % 100] > max_last[type]) max_last[type] = t - last_time[type][(loop_pos[type] + 99) % 100]; } loop_time[type][100] = t; } else { loop_time[type][loop_pos[type]] = CLOCK_getms() - loop_time[type][100]; if (loop_time[type][loop_pos[type]] > max_loop[type]) max_loop[type] = loop_time[type][loop_pos[type]]; if (type == 0 && loop_pos[0] == 99) { unsigned avg_loop[4] = {0, 0, 0, 0}; unsigned avg_last[2] = {0, 0}; for(int i = 0; i < 99; i++) { for(int t = 0; t < 2; t++) { u32 delay = last_time[t][(i + loop_pos[t] + 2) % 100] - last_time[t][(i + loop_pos[t] + 1) % 100]; avg_last[t] += delay; } for(int t = 0; t < 4; t++) avg_loop[t] += loop_time[t][i]; } for(int t = 0; t < 4; t++) avg_loop[t] /= 99; avg_last[0] /= 99; avg_last[1] /= 99; printf("Avg: radio: %d mix: %d med: %d/%d low: %d/%d\n", avg_loop[3], avg_loop[2], avg_loop[1], avg_last[1], avg_loop[0], avg_last[0]); printf("Max: radio: %d mix: %d med: %d/%d low: %d/%d\n", max_loop[3], max_loop[2], max_loop[1], max_last[1], max_loop[0], max_last[0]); memset(max_loop, 0, sizeof(max_loop)); max_last[0] = 0; max_last[1] = 0; } } } #endif void debug_switches() { s32 data[INP_LAST]; for(int i = INP_HAS_CALIBRATION+1; i < INP_LAST; i++) { data[i] = CHAN_ReadRawInput(i); } while(1) { u32 changed = 0; for(int i = INP_HAS_CALIBRATION+1; i < INP_LAST; i++) { s32 val = CHAN_ReadRawInput(i); if (val != data[i]) { printf("%s=%d ", INPUT_SourceName(tempstring, i), val); data[i] = val; changed = 1; } } if (changed) { printf("\n"); } if(PWR_CheckPowerSwitch()) PWR_Shutdown(); } }
void MUSIC_PlayValue(u16 music, s32 value, u8 unit, u8 prec) { u32 i; char digits[6]; // Do we need more? char thousands = 0; u8 digit_count = 0; if ( !AUDIO_VoiceAvailable() || !AUDIO_AddQueue(music)) { if (music < MUSIC_TOTAL) MUSIC_Play(music); return; } // Play minutes/hours/seconds for timers if (unit == VOICE_UNIT_TIME) { if (value >= 3600) { i = value / 3600; AUDIO_AddQueue(i + MUSIC_TOTAL); AUDIO_AddQueue(VOICE_UNIT_HOURS + VOICE_UNIT_OFFSET); value %= 3600; } if (value >= 60) { i = value / 60; AUDIO_AddQueue(i + MUSIC_TOTAL); AUDIO_AddQueue(VOICE_UNIT_MINUTES + VOICE_UNIT_OFFSET); value %= 60; } if (value > 0) { AUDIO_AddQueue(value + MUSIC_TOTAL); AUDIO_AddQueue(VOICE_UNIT_SECONDS + VOICE_UNIT_OFFSET); } return; } // Add minus sign for negative number if (value < 0) { AUDIO_AddQueue(VOICE_UNIT_MINUS + VOICE_UNIT_OFFSET); value *= -1; } //Add precision digits for (i=0; i < prec; i++) { digits[digit_count++] = value % 10; value /=10; } //Add decimal seperator if (prec > 0) { digits[digit_count++] = VOICE_DEC_SEP; } // Special case value == 0 and not playing TIME if (value == 0 && unit != VOICE_UNIT_TIME) digits[digit_count++] = 0; // Get single digits from remaining value while (value > 0) { if(value > 999) { thousands = value / 1000; value %= 1000; } if(value > 100) { digits[digit_count++] = value % 100; value /= 100; digits[digit_count++] = value + 99; if (thousands){ digits[digit_count++] = 109; // MP3 for "thousands" digits[digit_count++] = thousands; } break; } if(value < 101 && value > 0) { digits[digit_count++] = value; break; } else { if (thousands){ digits[digit_count++] = 109; // MP3 for "thousands" digits[digit_count++] = thousands; } } } // Fill music queue with digits for (i = digit_count; i > 0; i--) { AUDIO_AddQueue(digits[i-1] + MUSIC_TOTAL); } // Add unit for value if specified if (unit > VOICE_UNIT_NONE) AUDIO_AddQueue(unit + VOICE_UNIT_OFFSET); }