python - Arduino 串行命令独立工作,但组合时没有任何反应

标签 python arduino pyserial arduino-c++ usbserial

我已将 Arduino 连接到树莓派,以便在我发送信号(在本例中为数字)时触发特定事件。当我用脚本发送一个数字并告诉它只在串行监视器中打印时它工作,当我尝试让它在启动时运行电机时它工作正常,但是当将两者结合时:让它运行一个特定的命令如果收到特定号码没有任何反应。如果有人能指出这里的缺陷,我将不胜感激。 Python 代码:

import serial, time
arduino = serial.Serial('/dev/ttyUSB0', 9600, timeout=1)
cmd = ''
while cmd != '0':
        cmd = input('Enter a cmd ')
        arduino.write(cmd.encode('ascii'))

Arduino 代码:

#include <Arduino.h>

const byte MOTOR_A = 3;  // Motor 2 Interrupt Pin - INT 1 - Right Motor
const byte MOTOR_B = 2;  // Motor 1 Interrupt Pin - INT 0 - Left Motor
 
// Constant for steps in disk
const float stepcount = 20.00;  // 20 Slots in disk, change if different
 
// Constant for wheel diameter
const float wheeldiameter = 66.10; // Wheel diameter in millimeters, change if different
const float gear_ratio = 34;
const float PPR = 12;

// Integers for pulse counters
volatile int counter_A = 0;
volatile int counter_B = 0;
 
 
// Motor A
 
int enA = 10;
int in1 = 9;
int in2 = 8;
 
// Motor B
 
int enB = 5;
int in3 = 7;
int in4 = 6;
 
// Interrupt Service Routines
 
// Motor A pulse count ISR
void ISR_countA()  
{
  counter_A++;  // increment Motor A counter value
} 
 
// Motor B pulse count ISR
void ISR_countB()  
{
  counter_B++;  // increment Motor B counter value
}
 
// Function to convert from centimeters to steps
int CMtoSteps(float cm) 
{
  float circumference = (wheeldiameter * 3.14) / 10; // Calculate wheel circumference in cm
  
  return int(cm * gear_ratio * PPR / circumference); 
 
}
 
// Function to Move Forward
void MoveForward(int steps, int mspeed) 
{
   counter_A = 0;  //  reset counter A to zero
   counter_B = 0;  //  reset counter B to zero
   
   // Set Motor A forward
   digitalWrite(in1, HIGH);
   digitalWrite(in2, LOW);
 
   // Set Motor B forward
   digitalWrite(in3, HIGH);
   digitalWrite(in4, LOW);
   
   // Go forward until step value is reached
   while (steps > counter_A or steps > counter_B) {
   
    if (steps > counter_A) {
    analogWrite(enA, mspeed);
    } else {
    analogWrite(enA, 0);
    }
    if (steps > counter_B) {
    analogWrite(enB, mspeed);
    } else {
    analogWrite(enB, 0);
    }
   }
    
  // Stop when done
  analogWrite(enA, 0);
  analogWrite(enB, 0);
  counter_A = 0;  //  reset counter A to zero
  counter_B = 0;  //  reset counter B to zero 
 
}
 
// Function to Move in Reverse
void MoveReverse(int steps, int mspeed) 
{
   counter_A = 0;  //  reset counter A to zero
   counter_B = 0;  //  reset counter B to zero
   
   // Set Motor A reverse
  digitalWrite(in1, LOW);
  digitalWrite(in2, HIGH);
 
  // Set Motor B reverse
  digitalWrite(in3, LOW);
  digitalWrite(in4, HIGH);
   
   // Go in reverse until step value is reached
   while (steps > counter_A && steps > counter_B) {
   
    if (steps > counter_A) {
    analogWrite(enA, mspeed);
    } else {
    analogWrite(enA, 0);
    }
    if (steps > counter_B) {
    analogWrite(enB, mspeed);
    } else {
    analogWrite(enB, 0);
    }
    }
    
  // Stop when done
  analogWrite(enA, 0);
  analogWrite(enB, 0);
  counter_A = 0;  //  reset counter A to zero
  counter_B = 0;  //  reset counter B to zero 
 
}
 
// Function to Spin Right
void SpinRight(int steps, int mspeed) 
{
   counter_A = 0;  //  reset counter A to zero
   counter_B = 0;  //  reset counter B to zero
   
   // Set Motor A reverse
  digitalWrite(in1, LOW);
  digitalWrite(in2, HIGH);
 
  // Set Motor B forward
  digitalWrite(in3, HIGH);
  digitalWrite(in4, LOW);
   
   // Go until step value is reached
   while (steps > counter_A && steps > counter_B) {
   
    if (steps > counter_A) {
    analogWrite(enA, mspeed);
    } else {
    analogWrite(enA, 0);
    }
    if (steps > counter_B) {
    analogWrite(enB, mspeed);
    } else {
    analogWrite(enB, 0);
    }
   }
    
  // Stop when done
  analogWrite(enA, 0);
  analogWrite(enB, 0);
  counter_A = 0;  //  reset counter A to zero
  counter_B = 0;  //  reset counter B to zero 
 
}
 
// Function to Spin Left
void SpinLeft(int steps, int mspeed) 
{
   counter_A = 0;  //  reset counter A to zero
   counter_B = 0;  //  reset counter B to zero
   
   // Set Motor A forward
  digitalWrite(in1, HIGH);
  digitalWrite(in2, LOW);
 
  // Set Motor B reverse
  digitalWrite(in3, LOW);
  digitalWrite(in4, HIGH);
   
   // Go until step value is reached
   while (steps > counter_A && steps > counter_B) {
   
    if (steps > counter_A) {
    analogWrite(enA, mspeed);
    } else {
    analogWrite(enA, 0);
    }
    if (steps > counter_B) {
    analogWrite(enB, mspeed);
    } else {
    analogWrite(enB, 0);
    }
  }
    
  // Stop when done
  analogWrite(enA, 0);
  analogWrite(enB, 0);
  counter_A = 0;  //  reset counter A to zero
  counter_B = 0;  //  reset counter B to zero 
 
}
 
void setup() 
{
  Serial.begin(9600);
  // Attach the Interrupts to their ISR's
  pinMode(MOTOR_A,INPUT);
  pinMode(MOTOR_B,INPUT);
  pinMode(in1,OUTPUT);
  pinMode(in2,OUTPUT);
  pinMode(in3,OUTPUT);
  pinMode(in4,OUTPUT);
  pinMode(enA,OUTPUT);
  pinMode(enB,OUTPUT);
  
  attachInterrupt(digitalPinToInterrupt (MOTOR_A), ISR_countA, RISING);  // Increase counter A when speed sensor pin goes High
  attachInterrupt(digitalPinToInterrupt (MOTOR_B), ISR_countB, RISING);  // Increase counter B when speed sensor pin goes High

} 
 
 
void loop()
{
  delay(100);
  int compareOne = 1;
  int compareTwo = 2;
  int compareThree = 3;
  if (Serial.available() > 0){
    String stringFromSerial = Serial.readString();
    if (stringFromSerial.toInt() == compareOne){
      Serial.println("Forward");
      MoveForward(CMtoSteps(50), 255);  // Forward half a metre at 255 speed
    }
    if (stringFromSerial.toInt() == compareTwo){
       Serial.println("Spin Right");
       SpinRight(CMtoSteps(10), 255);  // Right half a metre at 255 speed
    } 
    if (stringFromSerial.toInt() == compareThree){
      Serial.println("Spin Left");
      SpinLeft(CMtoSteps(10), 255);  // Right half a metre at 255 speed
    }
    else {
      Serial.println("Not equal");
    }
  }
  Put whatever you want here!
   MoveReverse(CMtoSteps(25.4),255);  // Reverse 25.4 cm at 255 speed
}

更新:我已经更改了循环,以便它按照@GrooverFromHolland 的建议比较整数而不是字符串。尽管如此,当我从 python 输入时没有任何反应,但它被打印在串行监视器中。为什么当我直接在循环中触发电机进行测试时电机会旋转,但在通过串行监视器发出命令时却不会旋转是我的问题。除此之外,我发现中断由于某种原因无法正常工作。任何帮助表示赞赏。

最佳答案

我看到您在 RISING 模式下使用数字 I/O 中断。在我这里的 Arduino Duemilanove 上,如果引脚未连接(即高阻),RISING 模式中断将连续触发。因此,如果您的电机硬件未充分加载输入引脚,则可以解释您的观察结果,因此计数器 A、B 正在“立即”递增。在这种情况下,电机函数(MoveForward() 等)会很快退出,因为 counter_A > steps,基本上只要函数被调用就退出。看起来什么也没有发生,即使函数被执行了。

您可以通过将引脚 2,3 连接到 GND 来测试这个理论。然后电机应该无限期地运行(计数器不会增加)。您还可以将 counter_A 和 counter_B 的值打印到串行监视器。

此外,您可能需要注意信号与中断引脚的连接。可能需要一些去毛刺电容、上拉电阻或其他信号调节。打印计数器值也有助于此。

关于python - Arduino 串行命令独立工作,但组合时没有任何反应,我们在Stack Overflow上找到一个类似的问题: https://stackoverflow.com/questions/73668351/

相关文章:

c - Arduino ECG 溅射出完全随机的值

c - 如何让convert.c运行?

python - 当数据以空字符串开头时开始串行读取

python - 有没有办法在 Playwright 中返回响应正文?

python - 如何打印包含 unicode 字符的变量?

python - 递归打印带有分支的树

python - 无法导入conda环境中安装的包

c - Arduino UDPNTP Epoch,确定一天中的分钟

python - 在 python 中操作字符串

python - pyserial 错误 - 无法打开端口