SingleDuctedDroneSystem/Beeper.cpp at Float · H5L0/SingleDuctedDroneSystem · GitHub

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
#include "Beeper.h"
#include "Arduino.h"


 u8 Beeper::pattern    = 0;
 u8 Beeper::length     = 0;
 u8 Beeper::position   = 0;
 u8 Beeper::wait_timer = 0;


void Beeper::Init()
{
	pinMode(PIN_BEEPER, OUTPUT);
}


void Beeper::Beep(u8 pattern, u8 length, bool block)
{
	//还未开始loop循环, 堵塞鸣叫
	if(block)
	{
		//不提供无限鸣叫
		for(u8 i = 0; i != length; i++)
		{
			u8 pos = i & 0b111;
			u8 beep = (pattern >> pos) & 1;
			digitalWrite(PIN_BEEPER, beep);
			delay(250);
		}
		digitalWrite(PIN_BEEPER, LOW);
	}
	else
	{
		Beeper::length = length;
		Beeper::wait_timer = 0;
		Beeper::pattern = pattern;
		Beeper::position = 0;

		digitalWrite(PIN_BEEPER, pattern & 1);
	}
}


void Beeper::Update(u8 delta_time_1024)
{
	//无蜂鸣器任务
	if(pattern == 0) return;

	u16 t = wait_timer + delta_time_1024;
	if(t > BEEPER_CYCLE)
	{
		wait_timer = 0;
		position++;

		//Pattern结束
		if(length != 255 && position == length)
		{
			length = 0;
			pattern = 0;
			digitalWrite(PIN_BEEPER, LOW);
		}
		//切换到Pattern下一节
		else
		{
			u8 pos = position & 0b111;
			u8 beep = (pattern >> pos) & 1;
			digitalWrite(PIN_BEEPER, beep);
		}

	}
	else wait_timer = (u8)t;
}