| if(block) { | if(block) { | ||||
| bp = block->data; | bp = block->data; | ||||
| uint32_t tmp = tone_freq >> 32; | uint32_t tmp = tone_freq >> 32; | ||||
| uint64_t tone_tmp = (0x400000000000LL * (int)(tmp&0x7fffffff)) / (int) AUDIO_SAMPLE_RATE_EXACT; | |||||
| uint64_t tone_tmp = (tone_freq << 14) / (int) AUDIO_SAMPLE_RATE_EXACT; | |||||
| uint64_t incr = (tone_incr << 14) / (int) AUDIO_SAMPLE_RATE_EXACT; | |||||
| // Generate the sweep | // Generate the sweep | ||||
| for(i = 0;i < AUDIO_BLOCK_SAMPLES;i++) { | for(i = 0;i < AUDIO_BLOCK_SAMPLES;i++) { | ||||
| *bp++ = (short)(( (short)(arm_sin_q31((uint32_t)((tone_phase >> 15)&0x7fffffff))>>16) *tone_amp) >> 15); | *bp++ = (short)(( (short)(arm_sin_q31((uint32_t)((tone_phase >> 15)&0x7fffffff))>>16) *tone_amp) >> 15); | ||||
| tone_phase += tone_tmp; | tone_phase += tone_tmp; | ||||
| if(tone_phase & 0x800000000000LL)tone_phase &= 0x7fffffffffffLL; | |||||
| tone_tmp += incr ; | |||||
| if(tone_sign > 0) { | if(tone_sign > 0) { | ||||
| if(tmp > tone_hi) { | if(tmp > tone_hi) { |