86 lines
1.3 KiB
C++
86 lines
1.3 KiB
C++
#include "BlinkPort.h"
|
|
#include "Kernel\Task.h"
|
|
|
|
static void BlinkTask(void* param);
|
|
|
|
BlinkPort::BlinkPort()
|
|
{
|
|
_tid = 0;
|
|
|
|
Buffer(Ports, sizeof(Ports)).Clear();
|
|
Count = 0;
|
|
|
|
First = true;
|
|
Times = 10;
|
|
Interval1 = 100;
|
|
Interval2 = 300;
|
|
Index = 0;
|
|
}
|
|
|
|
BlinkPort::~BlinkPort()
|
|
{
|
|
Sys.RemoveTask(_tid);
|
|
}
|
|
|
|
void BlinkPort::Add(OutputPort* port)
|
|
{
|
|
Ports[Count++] = port;
|
|
}
|
|
|
|
void BlinkPort::Start()
|
|
{
|
|
if(!Count) return;
|
|
|
|
Current = First;
|
|
Index = 0;
|
|
|
|
for(int i=0; i<Count; i++)
|
|
{
|
|
Ports[i]->Open();
|
|
}
|
|
|
|
if(!_tid) _tid = Sys.AddTask(BlinkTask, this, -1, -1, "闪烁端口");
|
|
|
|
// 开启一次任务
|
|
Sys.SetTask(_tid, true);
|
|
}
|
|
|
|
void BlinkPort::Stop()
|
|
{
|
|
Sys.SetTask(_tid, false);
|
|
for(int i=0; i<Count; i++)
|
|
{
|
|
Ports[i]->Write(!First);
|
|
}
|
|
}
|
|
|
|
void BlinkPort::Blink()
|
|
{
|
|
bool f = Current;
|
|
int t = Interval1;
|
|
if(Index & 0x01) t = Interval2;
|
|
|
|
//debug_printf("翻转到状态 %d Index=%d Next=%d\r\n", Current, Index, t);
|
|
|
|
for(int i=0; i<Count; i++)
|
|
{
|
|
Ports[i]->Write(f);
|
|
}
|
|
|
|
// 如果闪烁次数不够，则等下一次
|
|
Index++;
|
|
if(Index < Times)
|
|
{
|
|
Current = !Current;
|
|
|
|
// 切换任务执行时间
|
|
Sys.SetTask(_tid, true, t);
|
|
}
|
|
}
|
|
|
|
void BlinkTask(void* param)
|
|
{
|
|
BlinkPort* bp = (BlinkPort*)param;
|
|
bp->Blink();
|
|
}
|