上图我做的,平均1秒转一圈,每转一圈磁铁触发传感器输出一个低电平,
若
3秒内检测不到触发电平就证明电机卡主了。输出信号控制电机停止,朋友们,怎么写个程序呢?求的思路,谢谢!
sbit KEY1=P2^0;//检测端口接霍尔传感器输出端,低电平有效
sbit KEY2=P2^1;//输出高电平,启动继电器,断开电源,或者接步进电机控制器的 停止端
void main()
{ KEY1=1;//通电默认高电平
KEY2=0;//通电默认低电平
while(1)
{
if(KEY1==0) //读P2.0引脚
{
delay_ms(5); //延时10ms消抖
if(KEY1==0) //再次判断,防止干扰,增强稳定
{
|