Work on endstopcamerashield.h
This commit is contained in:
parent
603d5b0219
commit
d1028a7e02
|
@ -0,0 +1,26 @@
|
|||
#ifndef EndstopCameraShield_h
|
||||
#define EndstopCameraShield_h
|
||||
|
||||
#include <Arduino.h>
|
||||
|
||||
/**
|
||||
* Default pins
|
||||
* 2 Close Receiver Pin
|
||||
* 3 Open Receiver Pin
|
||||
* 4 Open Emitter Pin
|
||||
* 5 Close Emitter Pin
|
||||
**/
|
||||
|
||||
class EndstopCameraShield {
|
||||
private:
|
||||
const
|
||||
|
||||
public:
|
||||
|
||||
EndstopCameraShield();
|
||||
|
||||
void setup();
|
||||
void loop();
|
||||
};
|
||||
|
||||
#endif
|
|
@ -0,0 +1,74 @@
|
|||
/// mcopy Serial Library
|
||||
|
||||
#include "McopySerial.h"
|
||||
|
||||
McopySerial::McopySerial () {}
|
||||
|
||||
void McopySerial::begin (char identity) {
|
||||
id = identity;
|
||||
Serial.begin(baud);
|
||||
Serial.flush();
|
||||
Serial.setTimeout(serialDelay);
|
||||
}
|
||||
|
||||
char McopySerial::loop () {
|
||||
if (Serial.available()) {
|
||||
cmdChar = (char) Serial.read();
|
||||
_internal();
|
||||
} else {
|
||||
cmdChar = 'z';
|
||||
}
|
||||
return cmdChar;
|
||||
}
|
||||
|
||||
void McopySerial::_internal () {
|
||||
if (cmdChar == DEBUG) {
|
||||
debug(!debugOn);
|
||||
} else if (cmdChar == CONNECT) {
|
||||
_connect();
|
||||
} else if (cmdChar == MCOPY_IDENTIFIER) {
|
||||
_identify();
|
||||
}
|
||||
}
|
||||
|
||||
void McopySerial::_connect () {
|
||||
connected = true;
|
||||
Serial.println(CONNECT);
|
||||
log("connect()");
|
||||
}
|
||||
|
||||
void McopySerial::_identify () {
|
||||
identified = true;
|
||||
Serial.println(id);
|
||||
log("identify()");
|
||||
}
|
||||
|
||||
void McopySerial::debug (bool state) {
|
||||
debugOn = state;
|
||||
log("debug()");
|
||||
}
|
||||
|
||||
void McopySerial::confirm (char cmd) {
|
||||
Serial.println(cmd);
|
||||
}
|
||||
|
||||
void McopySerial::log (String message) {
|
||||
if (debugOn) {
|
||||
Serial.println(message);
|
||||
}
|
||||
}
|
||||
|
||||
String McopySerial::getString () {
|
||||
while (Serial.available() == 0) {
|
||||
//Wait for value string
|
||||
}
|
||||
return Serial.readString();
|
||||
}
|
||||
|
||||
void McopySerial::sendString (String str) {
|
||||
Serial.println(str);
|
||||
}
|
||||
|
||||
void McopySerial::print (String message) {
|
||||
Serial.println(message);
|
||||
}
|
|
@ -0,0 +1,89 @@
|
|||
#ifndef MCOPY_SERIAL
|
||||
#define MCOPY_SERIAL
|
||||
|
||||
#include <Arduino.h>
|
||||
|
||||
class McopySerial {
|
||||
|
||||
private:
|
||||
|
||||
const uint16_t serialDelay = 5;
|
||||
const uint16_t baud = 57600;
|
||||
|
||||
volatile bool debugOn = false;
|
||||
volatile char cmdChar = 'z';
|
||||
volatile char id;
|
||||
|
||||
void _internal ();
|
||||
void _connect ();
|
||||
void _identify ();
|
||||
|
||||
public:
|
||||
|
||||
volatile bool connected = false;
|
||||
volatile bool identified = false;
|
||||
|
||||
/* CMD FLAGS */
|
||||
const char BLACK = 'b';
|
||||
const char CAMERA = 'c';
|
||||
const char CAMERA_BACKWARD = 'f';
|
||||
const char CAMERA_CAPPER_IDENTIFIER = '8';
|
||||
const char CAMERA_CAPPER_PROJECTOR_IDENTIFIER = '9';
|
||||
const char CAMERA_CAPPER_PROJECTORS_IDENTIFIER = '0';
|
||||
const char CAMERA_EXPOSURE = 'G';
|
||||
const char CAMERA_FORWARD = 'e';
|
||||
const char CAMERA_IDENTIFIER = 'k';
|
||||
const char CAMERA_PROJECTORS_IDENTIFIER = '5';
|
||||
const char CAMERA_SECOND = '3';
|
||||
const char CAMERA_SECOND_BACKWARD = '2';
|
||||
const char CAMERA_SECOND_FORWARD = '1';
|
||||
const char CAMERA_SECOND_IDENTIFIER = 'y';
|
||||
const char CAMERA_TIMED = 'n';
|
||||
const char CAMERAS = '4';
|
||||
const char CAMERAS_IDENTIFIER = 'a';
|
||||
const char CAMERAS_PROJECTOR_IDENTIFIER = '6';
|
||||
const char CAMERAS_PROJECTORS_IDENTIFIER = '7';
|
||||
const char CAPPER_IDENTIFIER = 'C';
|
||||
const char CAPPER_OFF = 'B';
|
||||
const char CAPPER_ON = 'A';
|
||||
const char CONNECT = 'i';
|
||||
const char DEBUG = 'd';
|
||||
const char ERROR = 'E';
|
||||
const char HOME = 'I';
|
||||
const char LIGHT = 'l';
|
||||
const char LIGHT_IDENTIFIER = 'o';
|
||||
const char MCOPY_IDENTIFIER = 'm';
|
||||
const char OFFSET = 'O';
|
||||
const char PROJECTOR = 'p';
|
||||
const char PROJECTOR_BACKWARD = 'h';
|
||||
const char PROJECTOR_CAMERA_IDENTIFIER = 's';
|
||||
const char PROJECTOR_CAMERA_LIGHT_IDENTIFIER = 'r';
|
||||
const char PROJECTOR_FORWARD = 'g';
|
||||
const char PROJECTOR_IDENTIFIER = 'j';
|
||||
const char PROJECTOR_LIGHT_IDENTIFIER = 'q';
|
||||
const char PROJECTOR_SECOND = 'w';
|
||||
const char PROJECTOR_SECOND_BACKWARD = 'v';
|
||||
const char PROJECTOR_SECOND_FORWARD = 'u';
|
||||
const char PROJECTOR_SECOND_IDENTIFIER = 't';
|
||||
const char PROJECTORS = 'x';
|
||||
const char PROJECTORS_IDENTIFIER = 'd';
|
||||
const char STATE = 'H';
|
||||
const char TAKEUP_BACKWARD = 'F';
|
||||
const char TAKEUP_FORWARD = 'D';
|
||||
/* END CMD FLAGS */
|
||||
|
||||
McopySerial();
|
||||
|
||||
void begin(char identity);
|
||||
char loop();
|
||||
void confirm(char cmd);
|
||||
String getString();
|
||||
void print(String message);
|
||||
void sendString(String str);
|
||||
|
||||
void debug (bool state);
|
||||
void log (String message);
|
||||
|
||||
};
|
||||
|
||||
#endif
|
|
@ -0,0 +1,76 @@
|
|||
#include "TB6600MotorDriver.h"
|
||||
|
||||
TB6600MotorDriver::TB6600MotorDriver() {
|
||||
//
|
||||
}
|
||||
|
||||
TB6600MotorDriver::TB6600MotorDriver(uint8_t enablePin, uint8_t directionPin, uint8_t pulsePin, uint32_t usPulse, uint8_t microsteps) {
|
||||
_enablePin = enablePin;
|
||||
_directionPin = directionPin;
|
||||
_pulsePin = pulsePin;
|
||||
|
||||
_usPulse = usPulse;
|
||||
_microsteps = microsteps;
|
||||
_revsteps = 200 * microsteps;
|
||||
}
|
||||
|
||||
|
||||
void TB6600MotorDriver::setup() {
|
||||
if (_enablePin != 0) {
|
||||
pinMode(_enablePin, OUTPUT);
|
||||
}
|
||||
pinMode(_directionPin, OUTPUT);
|
||||
pinMode(_pulsePin, OUTPUT);
|
||||
|
||||
digitalWrite(_directionPin, LOW);
|
||||
digitalWrite(_enablePin, HIGH);
|
||||
}
|
||||
|
||||
void TB6600MotorDriver::setDirection(uint8_t direction) {
|
||||
if (direction != _direction) {
|
||||
_direction = direction;
|
||||
_setDirection();
|
||||
}
|
||||
}
|
||||
|
||||
void TB6600MotorDriver::_setDirection{
|
||||
digitalWrite(_directionPin, _direction ? LOW : HIGH);
|
||||
}
|
||||
|
||||
void TB6600MotorDriver::setSpeed(uint16_t rpm) {
|
||||
_usPulse = 60000000 / ((uint32_t) revsteps * (uint32_t) rpm);
|
||||
}
|
||||
|
||||
void TB6600MotorDriver::steps(uint64_t stepCount) {
|
||||
for (uint64_t i = 0; i < stepCount; i++) {
|
||||
_step();
|
||||
}
|
||||
}
|
||||
|
||||
void TB6600MotorDriver::_step() {
|
||||
digitalWrite(_pulsePin, HIGH);
|
||||
delayMicroseconds(_usPulse);
|
||||
digitalWrite(_pulsePin, LOW);
|
||||
delayMicroseconds(_usPulse);
|
||||
}
|
||||
|
||||
void TB6600MotorDriver::step() {
|
||||
_step();
|
||||
}
|
||||
|
||||
void TB6600MotorDriver::release() {
|
||||
_enabled = false;
|
||||
_setEnable();
|
||||
}
|
||||
|
||||
void TB6600MotorDriver::enable() {
|
||||
_enabled = true;
|
||||
_setEnable();
|
||||
}
|
||||
|
||||
void TB6600MotorDriver::_setEnable() {
|
||||
if (_enablePin != 0) {
|
||||
digitalWrite(_enablePin, _enabled ? HIGH : LOW);
|
||||
}
|
||||
}
|
||||
|
|
@ -0,0 +1,52 @@
|
|||
#ifndef TB6600MotorDriver_h
|
||||
#define TB6600MotorDriver_h
|
||||
|
||||
#include <Arduino.h>
|
||||
|
||||
/**
|
||||
* Default pins
|
||||
* D6 Enable +
|
||||
* D7 Direction +
|
||||
* D8 Pulse +
|
||||
**/
|
||||
|
||||
class TB6600MotorDriver {
|
||||
private:
|
||||
|
||||
volatile uint8_t _enablePin = 0; //0 is disabled
|
||||
volatile uint8_t _directionPin = 7;
|
||||
volatile uint8_t _pulsePin = 8;
|
||||
|
||||
volatile uint32_t _usPulse = 300;
|
||||
|
||||
//physically set, can't change
|
||||
volatile uint8_t _microsteps = 1; //1, 2, 4, 8, 16, 32
|
||||
|
||||
volatile uint16_t _revsteps = 200; // # steps per revolution
|
||||
volatile bool _direction = true;
|
||||
volatile bool _enabled = true;
|
||||
|
||||
void _step();
|
||||
void _setDirection();
|
||||
void _setEnable();
|
||||
|
||||
public:
|
||||
|
||||
TB6600MotorDriver();
|
||||
TB6600MotorDriver(uint8_t enablePin, uint8_t directionPin, uint8_t pulsePin, uint32_t usPulse, uint8_t microsteps);
|
||||
|
||||
|
||||
void setup();
|
||||
|
||||
void setDirection(uint8_t direction);
|
||||
void setSpeed(uint16_t rpm);
|
||||
|
||||
//full
|
||||
void steps(uint64_t stepCount);
|
||||
void step();
|
||||
|
||||
void enable();
|
||||
void release();
|
||||
};
|
||||
|
||||
#endif
|
|
@ -0,0 +1,10 @@
|
|||
#include "EndstopCameraShield.h"
|
||||
#include "McopySerial.h"
|
||||
|
||||
void setup () {
|
||||
|
||||
}
|
||||
|
||||
void loop () {
|
||||
|
||||
}
|
|
@ -26,6 +26,7 @@ SKETCHES=(
|
|||
components/mcopy_light
|
||||
mcopy_projector_firmware
|
||||
mcopy_ACME_Trebes_Nanolab
|
||||
mcopy_oxberry_mitchell
|
||||
)
|
||||
|
||||
for sketch in "${SKETCHES[@]}"; do
|
||||
|
|
Loading…
Reference in New Issue