我正在通过 arduino 控制两个电机继电器。设置如下:
每个继电器都由一个简单的开关设置控制。当开关闭合时,继电器激活。当开关打开时,继电器不活动。
我决定试一试 protothreads,因为我希望这两个开关可以并行控制电机。为此,我编写了以下代码:
#include <pt.h>
#define yMaxLimitLeft 8 //these are the limit switches that control the relays
#define yMaxLimitRight 9 //these are the limit switches that control the relays
#define leftRelay 4
#define rightRelay 5
static struct pt pt1, pt2; // each protothread needs one of these
void setup() {
Serial.begin(9600);
PT_INIT(&pt1); // initialise the two
PT_INIT(&pt2); // protothread variables
pinMode(leftRelay, OUTPUT); //set pins
pinMode(rightRelay, OUTPUT);
pinMode(yMaxLimitLeft,INPUT);
pinMode(yMaxLimitRight,INPUT);
}
void loop() {
digitalWrite(leftRelay, HIGH);//enable relays
digitalWrite(rightRelay, HIGH);//enable relays
runLeft(&pt1); //protothreads that controls relay number 1
runRight(&pt2); //protothreads that controls relay number 2
}
/////////////////////////////////////////////////////////////////////////////
// This function controls the left relay
static int runLeft(struct pt *pt) {
PT_BEGIN(pt);
while(1){
PT_WAIT_UNTIL(pt, digitalRead(yMaxLimitLeft)==HIGH); //wait until the switch is closed
Serial.println("left off");
digitalWrite(leftRelay, LOW);//disable relay
}
PT_END(pt);
}
//this function controls the right relay
static int runRight(struct pt *pt) {
PT_BEGIN(pt);
while(1){
PT_WAIT_UNTIL(pt, digitalRead(yMaxLimitRight)==HIGH); //wait until the switch is closed
Serial.println("Right off");
digitalWrite(rightRelay, LOW);//disable relay
}
PT_END(pt);
}
问题如下。只要我按下一个开关,相应的继电器就会响应。但是,当我按下两个开关时,只有一个继电器响应(可能是最早触发的那个)。
如何修复代码,以便在按住两个开关时,两个继电器同时响应?
非常感谢您的时间和提前帮助