1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
|
//******************************************************************************
// @file SoundDrv.cpp
// @author Nicolai Shlapunov
//
// @details DevCore: Sound Driver Class, implementation
//
// @copyright Copyright (c) 2017, Devtronic & Nicolai Shlapunov
// All rights reserved.
//
// @section SUPPORT
//
// Devtronic invests time and resources providing this open source code,
// please support Devtronic and open-source hardware/software by
// donations and/or purchasing products from Devtronic.
//
//******************************************************************************
// *****************************************************************************
// *** Includes ************************************************************
// *****************************************************************************
#include "SoundDrv.h"
#include "Rtos.h"
// *****************************************************************************
// *** Get Instance ********************************************************
// *****************************************************************************
SoundDrv& SoundDrv::GetInstance(void)
{
// This class is static and declared here
static SoundDrv sound_drv;
// Return reference to class
return sound_drv;
}
// *****************************************************************************
// *** Init Display Driver Task ********************************************
// *****************************************************************************
void SoundDrv::InitTask(TIM_HandleTypeDef* htm)
{
// Save timer handle
htim = htm;
// Create task
CreateTask();
}
// *****************************************************************************
// *** Sound Driver Setup **************************************************
// *****************************************************************************
Result SoundDrv::Setup()
{
// Init ticks variable
last_wake_ticks = RtosTick::GetTickCount();
// Always ok
return Result::RESULT_OK;
}
// *****************************************************************************
// *** Sound Driver Loop ***************************************************
// *****************************************************************************
Result SoundDrv::Loop()
{
// Flag
bool is_playing = false;
// Take mutex before start playing sound
melody_mutex.Lock();
// Delay for playing one frequency
uint32_t current_delay_ms = delay_ms;
// If no current melody or melody size is zero - skip playing
if((sound_table != nullptr) && (sound_table_size != 0U))
{
// Set flag that still playing sound
is_playing = true;
// If frequency greater than 18 Hz
if(((uint32_t)sound_table[sound_table_position] >> 4U) > 0x12U)
{
Tone(sound_table[sound_table_position] >> 4U);
}
else
{
// Otherwise "play" silence
Tone(0U);
}
// Get retry counter from table and calculate delay
current_delay_ms *= sound_table[sound_table_position] & 0x0FU;
// Increase array index
sound_table_position++;
// If end of melody reached
if(sound_table_position >= sound_table_size)
{
// If set repeat flag
if(repeat == true)
{
// Reset index for play melody from beginning
sound_table_position = 0U;
}
else
{
// Otherwise stop playing sound
StopSound();
}
}
}
// Give mutex after start playing sound
melody_mutex.Release();
// Pause until next tick
RtosTick::DelayUntilMs(last_wake_ticks, current_delay_ms);
// Using semaphore here helps block this task while task wait request for
// sound playing.
if(is_playing == false)
{
// Wait semaphore for start play melody
sound_update.Take();
}
// Always run
return Result::RESULT_OK;
}
// *****************************************************************************
// *** Beep function *******************************************************
// *****************************************************************************
void SoundDrv::Beep(uint16_t freq, uint16_t del, bool pause_after_play)
{
// Take mutex before beeping - prevent play melody during beeping.
melody_mutex.Lock();
// Start play tone
Tone(freq);
// Delay
RtosTick::DelayMs(del);
// Stop play tone
Tone(0);
// If flag is set
if(pause_after_play == true)
{
// Delay with same value as played sound
RtosTick::DelayMs(del);
}
// Give mutex after beeping
melody_mutex.Release();
}
// *****************************************************************************
// *** Play sound function *************************************************
// *****************************************************************************
void SoundDrv::PlaySound(const uint16_t* melody, uint16_t size, uint16_t temp_ms, bool rep)
{
// Parameters: pointer to melody table, size of melody and repetition flag.
// Format of sounds: 0x***#, where *** frequency, # - delay in temp_ms intervals
// If pointer is not nullptr, if size & freq time greater than zero
if((melody != nullptr) && (size > 0U) && (temp_ms > 0U))
{
// If already playing any melody
if(IsSoundPlayed() == true)
{
// Stop it first
StopSound();
}
// Take mutex before start playing melody
melody_mutex.Lock();
// Set repeat flag for melody
repeat = rep;
// Set time for one frequency
delay_ms = temp_ms;
// Set initial index for melody
sound_table_position = 0;
// Set melody size
sound_table_size = size;
// Set melody pointer
sound_table = melody;
// Give mutex after start playing melody
melody_mutex.Release();
// Give semaphore for start play melody
sound_update.Give();
}
}
// *****************************************************************************
// *** Stop sound function *************************************************
// *****************************************************************************
void SoundDrv::StopSound(void)
{
// Take mutex before stop playing sound
melody_mutex.Lock();
// Clear sound table pointer
sound_table = nullptr;
// Clear sound table size
sound_table_size = 0;
// Clear sound table index
sound_table_position = 0;
// Set time for one frequency
delay_ms = 100U;
// Set repeat flag for melody
repeat = false;
// Stop sound
Tone(0);
// Give mutex after stop playing sound
melody_mutex.Release();
}
// *****************************************************************************
// *** Mute sound function *************************************************
// *****************************************************************************
void SoundDrv::Mute(bool mute_flag)
{
// Set mute flag
mute = mute_flag;
// If mute flag is set - call Tone() for stop tone
if(mute == true)
{
Tone(0U);
}
}
// *****************************************************************************
// *** Is sound played function ********************************************
// *****************************************************************************
bool SoundDrv::IsSoundPlayed(void)
{
// Return variable, false by default
bool ret = false;
// If sound_table is not nullptr - we still playing melody. No sense to use
// mutex here - get pointer is atomic operation.
if(sound_table != nullptr)
{
ret = true;
}
// Return result
return ret;
}
// *****************************************************************************
// *** Process Button Input function ***************************************
// *****************************************************************************
void SoundDrv::Tone(uint16_t freq)
{
// FIX ME: rewrite comment
// Òàéìåð çàïóñêàåòñÿ ñ ïàðàìåòðàìè:
// Clock source: System Clock
// Mode: CTC top = OCR2
// OC2 output: Toggle on compare match
// È ñ ðàçíûìè äåëèòåëÿìè äëÿ ðàçíûõ ÷àñòîò, ïîòîìó êàê:
// ïðè äåëèòåëå 64 íåâîçìîæíî ïîëó÷èòü ÷àñòîòó íèæå ~750Ãö
// ïðè äåëèòåëå 256 íà ÷àñòîòàõ > ~1500Ãö âûñîêà ïîãðåøíîñòü ãåíåðàöèè
// Äåëåíèå íà 4 àðãóìåíòîâ äëÿ òîãî, ÷òî áû AVR_Clock_Freq/x íå ïðåâûñèëî word
// Äåëåíèå íà äâà â êîíöå, ïîòîìó êàê íóæåí ïîëóïåðèîä
// Åñëè çâóê îòêëþ÷åí - òàéìåð îñòàíàâëèâàåòñÿ è ñíèìàåòñÿ íàïðÿæåíèå ñ ïèùàëêè
if((freq > 11) && (mute == false))
{
// Calculate prescaler
uint32_t prescaler = (HAL_RCC_GetHCLKFreq()/100U) / freq;
// Set the Prescaler value
htim->Instance->PSC = (uint32_t)prescaler;
// Generate an update event to reload the Prescaler and the repetition
// counter(only for TIM1 and TIM8) value immediately
htim->Instance->EGR = TIM_EGR_UG;
// Start timer in Output Compare match mode
(void) HAL_TIM_OC_Start(htim, channel);
}
else
{
// Stop timer
HAL_TIM_OC_Stop(htim, channel);
// Clear Speaker output pin for decrease power consumer
HAL_GPIO_WritePin(SPEAKER_GPIO_Port, SPEAKER_Pin, GPIO_PIN_RESET);
}
}
|