34 lines
818 B
C
34 lines
818 B
C
// ultrasonic distance sensor
|
|
#include "EXT.h"
|
|
#include "STC15F2K60S2.H"
|
|
#include "displayer.h"
|
|
#include "sys.h"
|
|
#include "universal_decode_table.h"
|
|
|
|
code unsigned long SysClock = 11059200; //必须。定义系统工作时钟频率(Hz)，用户必须修改成与实际工作频率（下载时选择的）一致
|
|
|
|
void showDist()
|
|
{
|
|
int dist = GetUltraSonic(), num[5];
|
|
num[0] = dist / 10000;
|
|
num[1] = (dist % 10000) / 1000;
|
|
num[2] = (dist % 1000) / 100;
|
|
num[3] = (dist % 100) / 10;
|
|
num[4] = dist % 10;
|
|
Seg7Print(num[0], num[1], num[2], num[3], num[4], 0, 0, 0);
|
|
}
|
|
|
|
void main()
|
|
{
|
|
DisplayerInit();
|
|
EXTInit(enumEXTUltraSonic);
|
|
LedPrint(0);
|
|
SetDisplayerArea(0, 4);
|
|
MySTC_Init();
|
|
SetEventCallBack(enumEventSys10mS, showDist);
|
|
while (1)
|
|
{
|
|
MySTC_OS();
|
|
}
|
|
}
|