我借用PJRC's Encoder library管理步进式动力注射泵我正在使用Sparkfun RedBoard和BigEasy Driver。
我一直在模块化地开发程序,首先定义较低级别的类并从那里开始工作。我的欲望是更高级别的类将较低类的实例作为属性。在我目前的噩梦中,我正在建造一个带有步进电机和编码器对象作为属性的注射器泵类。
我将图书馆组织成一个标题文件,并且' .cpp'文件按照Arduino教程的建议。 Pump类在' Pump.h':
中声明如下#include "Arduino.h"
#include "Stepper.h"
#include "Encoder.h"
#define PUMP_TOP_SPEED 50 // ml/min top pump speed
#define PUMP_ERROR 10 // encoder counts acceptable error
class Pump {
private:
Stepper motor; // object stepper motor
Encoder encoder; // object attached encoder
int countPerRev; // # encoder counts per relovlution
float nominalVolume; // mL nominal syringe volume
float innerDiameter; // cm syringe inner diameter
float shaftLead; // cm driveshaft threading lead distance
float degVolume; // mL effective volume change per degree of rotation
bool state; // boolean T = ready, F = slept
public:
// constructor
Pump(const Stepper& stp, const Encoder& enc, int cpr, float vol, float diam, float lead);
float volume(); // returns nominalVolume
float position(); // returns current pump position in mL
void hold(); // high power state to resist back-pressure
void relax(); // low power state
void pump(float vol, float rate); // pumps the requested volume at requested rate
void release(); // moves the plunger all the way out so syringe can be serviced
void set(); // returns plunger to zero mL
};
' Pump.cpp'中的相关代码我一直在测试的文件是构造函数和pump()
方法的定义,它是这样的:
// constructor
Pump::Pump(const Stepper& stp, const Encoder& enc, int cpr, float vol, float diam, float lead) : motor(stp), encoder(enc), countPerRev(cpr), nominalVolume(vol), innerDiameter(diam), shaftLead(lead) {
// calculate volume per degree
// (diameter^2 / 4) * PI * (lead / 360) = mL / deg
// diam * diam * lead * PI / 360 / 4 = (diam diam lead PI) / 1440
degVolume = innerDiameter * innerDiameter * shaftLead * PI / 1440;
// construct the encoder inside here
/*encoder = new(Encoder(2,3));
// set it to 0
encoder.write(0);*/
}
// pumping function
void Pump::pump(float vol, float rate) {
/*
vol < 0 INFUSE
vol > 0 WITHDRAW
*/
if (rate > PUMP_TOP_SPEED) rate = PUMP_TOP_SPEED; // limit rate
if (!state) hold(); // wake up the motor if it's asleep
// make sure this doesn't push outside of the acceptable range
if (position() + vol <= nominalVolume && position() + vol >= 0) {
// (mL) / (mL/deg) = deg
float degrees = vol / degVolume; // find number of degrees to turn the motor
Serial.print("Looking to turn ");
Serial.print(degrees, DEC);
Serial.print(" degrees at ");
// (count) + (deg) * (count/rev) / (deg/rev) = count
long goal = encoder.read() + degrees * countPerRev / 360; // set target encoder reading
// (mL/min) / (mL/deg) / (deg/rev) = RPM
int rpm = abs(rate) / degVolume / 360; // find RPM to turn the motor
Serial.print(rpm, DEC);
Serial.println(" RPM in full-stepping mode");
Serial.print("Going from encoder count ");
Serial.print(encoder.read(), DEC);
Serial.print(" to ");
Serial.println(goal, DEC);
motor.drive(degrees, 1, rpm); // drive the pump
int err = goal - encoder.read(); // how far from the goal are we in counts?
Serial.print("Reached encoder count ");
Serial.println(encoder.read(), DEC);
Serial.print("Missed by ");
Serial.println(err, DEC);
}
}
我一直在测试我的pump()
方法并投入了大量Serial.print()
来尝试调试并弄清楚发生了什么以及从我所看到的,Encoder对象是泵对象的属性在轴转动时没有更新其位置,而在Arduino草图中声明的编码器对象 并传递给Pump构造函数确实
正如您在上面所看到的那样,我尝试在泵构造函数中初始化编码器,但是当我尝试编译时,我尝试的2或3件事都在Arduino IDE中引发了一堆神秘错误,留下了评论在部分,所以你可以看到我在尝试。
我觉得非常烦人的是,当我自己的Stepper对象工作正常时,Pump对象可以转动电机,Encoder对象在Pump对象内部不起作用。当我运行草图时:
#include <Stepper.h>
#include <Encoder.h>
#include <Pump.h>
// initialize stepper
Stepper motor(4, 5, 6, 7, 8, 9, 10, 11);
// initialize encoder
Encoder encoder(2, 3);
// initialize the pump
Pump pump(motor, encoder, 1440, 25, 2.328, 0.1);
void setup() {
// start the Serial connection
Serial.begin(9600);
// set up the motor
motor.enable();
motor.reset();
// pump
pump.pump(0.25,25);
Serial.print("Pump reading: ");
Serial.println(pump.position(), DEC);
Serial.print("Encoder reading: ");
Serial.println(encoder.read(), DEC);
// cool boards
pump.relax();
}
void loop() {}
我在串口监视器中取回了以下内容:
Looking to turn 211.4397277832 degrees at 58 RPM in full-stepping mode
Going from encoder count 0 to 845
Reached encoder count 0
Missed by 845
Pump reading: 0.0000000000
Encoder reading: 845
因此,方法encoder.read()
总是在Pump对象中返回零,但是当我在setup()
函数的草图末尾调用它时,它转向我完全按照我想要的方式转动。
感谢您的阅读。我非常感谢如何正确地将活动的Encoder对象传递给Pump,或者如何正确地初始化Pump中的Encoder对象而不会吓坏编译器。
答案 0 :(得分:0)
事实上,关键是要在Pump对象中初始化编码器,因为我已经在人们发布的Arduino板上阅读了我的问题的一些变体。
我在&#39; Pump.h&#39;的属性声明中构建了编码器。由于我使用的RedBoard是一个Arduino Uno,实质上,唯一可接受的引脚是2和3用于中断。我在类的私有属性列表下用以下行声明了编码器:
Encoder encoder = Encoder(2,3); // attached encoder
现在它完美无瑕。可能有一个选项可以将编码器引脚传递给Pump构造函数并使其具有灵活性,但目前我需要的东西比我需要的东西更完美。