Macroschlitten

Macroschlitten Status: stable
Beschreibung
Autor:	ptflea
Version	0.5
PayPal

Stepper läuft mit 12V

Hier ist der Ardunio-Code:

#include <AFMotor.h>
#include <AccelStepper.h>

// Connect a stepper motor with 48 steps per revolution (7.5 degree)
// to motor port #2 (M3 and M4)
int incomingByte;  
char Data[8];
int i;
unsigned long Zeit;
int bewegung;
int schritte;

int motorStepsPerRev = 200;
float currentMaxSpeed = 1200.0;
float currentAcceleration = 300.0;
const int stepType = INTERLEAVE;

AF_Stepper motor1(motorStepsPerRev, 2);
AF_Stepper motor2(motorStepsPerRev, 1);


void forwarda() {  
  motor1.onestep(FORWARD, stepType);
}
void backwarda() {  
  motor1.onestep(BACKWARD, stepType);
}

AccelStepper accelA(forwarda, backwarda);


void forwardb() {  
  motor2.onestep(FORWARD, stepType);
}
void backwardb() {  
  motor2.onestep(BACKWARD, stepType);
}

AccelStepper accelB(forwardb, backwardb);

int range_in;
int byte_in[2];         // variable to store the VALID data from the port
char nextMsg;


void setup(){
 
  motor1.setSpeed(50);  // in rpm 
  motor2.setSpeed(50);  // in rpm
  
  //Accelstepper Setup
  accelA.setMaxSpeed(currentMaxSpeed);
  accelA.setAcceleration(currentAcceleration);  
  accelB.setMaxSpeed(currentMaxSpeed);
  accelB.setAcceleration(currentAcceleration);
  
  accelA.setMinPulseWidth(10);
  accelB.setMinPulseWidth(10);
  
  
  Serial.begin(9600);
  digitalWrite(13, HIGH); //turn on LED to indicate program has started
}

void loop(){
  

   do {
     // Wenn Daten verfügbar Zeichen in Data schreiben bis 4 Zeichen erreicht oder 0,5 Sekunden Warten nach dem ersten übertragenen byte
     if (Serial.available()) {
	if (i == 0)
            {
              bewegung = Serial.read();
            }
            else
            {
             Data[i-1] = Serial.read();
         }
	 i++;
	 }    
     if(i<1)Zeit = millis();
     } while (i<4&&(millis()-Zeit) < 500); //nach i< kommt die Anzahl der Zeichen
    // Serial.flush(); //empty serial buffer
       // Abschließende Null für gültigen String
     Data[i-1] = 0;    
    
     schritte = atof(Data);  // Wert von String zu Zahl wandeln wenn gewünscht
     i=0;
     decodeMessage(bewegung, schritte); 
     
}

void decodeMessage(int msg, int range){
  int faktor = 5;
  //check command type and command value
  if(bitRead(msg, 0) == 1){
    //Bit 1 = High   DOWN (1)
   // motor1.step(faktor, FORWARD, INTERLEAVE); 
    	accelA.move(-range);
	accelA.runToPosition();
  }
  if(bitRead(msg, 1) == 1){
    //Bit 2 = High   UP (2)
    //motor1.step(faktor, BACKWARD, INTERLEAVE); 
	accelA.move(range);
	accelA.runToPosition(); 
  }
  if(bitRead(msg, 2) == 1){
    //Bit 3 = High   LEFT (4)
    motor1.step(faktor, FORWARD, INTERLEAVE); 
  }
  if(bitRead(msg, 3) == 1){
    //Bit 4 = High   RIGHT (8)
    motor1.step(faktor, BACKWARD, INTERLEAVE); 

  }
  if((msg & 15) == 0){
    //Bit 1-4 = Low
    //sendMsg(000); //send a message back for testing purposes
  }
  sendMsg(msg, range);
}



void sendMsg(int msg, int range){
  /* Processing uses Serial.buffer(4) to read the messages it receives,
   * meaning that messages of 4 bytes long should be sent.
   * Arduino sends integers as Strings, so to ensure 4 characters are sent
   * for each message, I check the size of the integer to send and add zeroes
   * as needed (zeroes ensure that the received message can easily be cast
   * to an integer by Processing, which would not be the case with other, non-numerical, characters)
   */
  //if(Serial.available() > 0) Serial.flush();
//  if(msg < 1000) Serial.print(0);
//  if(msg < 100) Serial.print(0);
//  if(msg < 10) Serial.print(0);
  //delay(1000); 
  
  Serial.print(range); //...send a confirmation
  Serial.println(msg);
 
}

Hier ist der Processing-Code:

import processing.serial.*;

Serial myPort;
PFont font;

String Schritte = "333";
int msgQueue[]; //the message queue
boolean msgLock; //message lock, active until last message is confirmed
int lstMsg; //last message sent
int schritt = 125;

void setup(){
  size(400, 300);
  background(0);
  font = createFont("Verdana", 14);
  
  msgQueue = new int[0];
  
  
  println(Serial.list());
 myPort = new Serial(this, Serial.list()[Serial.list().length - 1], 9600); //the highest connected COM port is always my Arduino
  //myPort.buffer(4); //buffer 4 bytes of data before calling serialEvent()
  myPort.bufferUntil('\n');

}

void draw(){
  background(0);
  textFont(font, 14);
  text("Taste 8: vorwärts\nTaste 7: weit vorwärts\n\nTaste 2: zurück\nTaste 1: weit zurück\n\n9 -> Schritt erhöhen\n3 -> Schritt verkleinern", 25, 25);
  text("Schritte: " + schritt, 25, 230);
  parseQueue();
}

void keyPressed(){
  if(int(key) == 50){// Taste 2 DOWN
    queueMessage(2); //
    //Schritte = Integer.toString(schritt);
    queueMessage(schritt);
  }
    if(int(key) == 56){// Taste 8 UP
    queueMessage(1); // 
    //Schritte = Integer.toString(schritt);
     queueMessage(schritt);
  }
    if(int(key) == 51){// Taste 3 Schritt verkleinern
    schritt = schritt - 5;
  }
    if(int(key) == 57){// Taste 9 Schritt erhöhen
    schritt = schritt + 5;
  }
    if(int(key) == 55){ //Taste 7 Grosser Schritt UP
    queueMessage(1); // 
    queueMessage(600);
  }
    if(int(key) == 49){ //Taste 1 Grosser Schritt DOWN
    queueMessage(2); // 
    queueMessage(600);
  }
}

/* serialEvent(Serial myPort)
 * called when the amount of bytes specified in myPort.buffer()
 * have been transmitted, converts serial message to integer,
 * then sets this value in the chair object
 */
void serialEvent(Serial myPort){
  if(myPort.available() > 0){
    
    String message = myPort.readString(); //read serial buffer
    int msg = int(message); //convert message to integer
    println(msgQueue.length);
    myPort.clear(); //clear whatever might be left in the serial buffer
    //msgLock = false;
     if(msg == 0){
      println("Anweisung durchgeführt");
      msgLock = false;
    }
  }
}

private void writeSerial(int msg){
  if(myPort.available() > 0) myPort.clear(); //empty serial buffer before sending
  myPort.write(msg);
}

public void queueMessage(int msg){
  msgQueue = append(msgQueue, msg);
}

private void parseQueue(){
  
    if(msgQueue.length > 0 && !msgLock) {
      msgLock = true; //lock queue, preventing new messages from being sent
      lstMsg = msgQueue[0]; //queue the first message on the stack
      writeSerial(lstMsg); // sende richtungsbefehl
      println("writing Richtung: " + lstMsg);
            
      msgQueue = subset(msgQueue, 1); // letzten befehl löschen
      
      lstMsg = msgQueue[0]; //queue the first message on the stack
      Schritte = Integer.toString(lstMsg);
      myPort.clear();
      myPort.write(Schritte);// sende Schrittzahl
      println("writing Schritte: " + lstMsg);
      
      msgQueue = subset(msgQueue, 1); // letzten befehl löschen
    }

}

Knitty: passap Firmware

//////////////////////////////////////////////////////////////////////////////
// Knitty Project
//
// Author: ptflea, schinken
//

//Servo
#include <Servo.h> 

Servo servoColour12;  // create servo object to control a servo 
Servo servoColour34;

#define INT_ENCODER 0
#define INT_IFDR    1

//////////////////////////////////////////////////////////////////////////////
// General purpose definitions

#define PIN_IFDR      3         // Green
#define PIN_CSENSE    2         // Yellow
#define PIN_CREF      4         // White
#define PIN_NEEDLE_RTL    5         // Blue,  Pattern RTL
#define PIN_NEEDLE_LTR    6         // ,  Pattern LTR
#define PIN_BUTTON_1  7         // Button_1 (activate colour change)
#define BUTTONDELAY   20        // delay for Button_1 
// PIN 8 and 9 are for the color change servos
#define PIN_Eyelet_1  10        // Eyelet_1 status
#define Eyelet_1_DELAY   100
#define PIN_Eyelet_2  11        // Eyelet_2 status
#define PIN_Eyelet_3  12        // Eyelet_3 status
#define PIN_Eyelet_4  13        // Eyelet_4 status


long buttonLastChecked = 0; // variable to limit the button getting checked every cycle
int button_1_State = 0;     // status of button_1
int button_1_Hold = 0; // toggle state of Button_1

long eyelet_1_LastChecked = 0;
int eyelet_1_State = 0;
int eyelet_1_Hold = 0;

#define DIRECTION_UNKNOWN       0
#define DIRECTION_LEFT_RIGHT   -1
#define DIRECTION_RIGHT_LEFT    1

char currentDirection = DIRECTION_UNKNOWN;
char lastDirection = DIRECTION_UNKNOWN;

signed int currentCursorPosition = 0;
signed int lastCursorPosition = 0;
signed int leftEndCursorPosition = 0;
unsigned int currentPatternIndex = 0;
signed int firstNeedle = 0;
signed int offsetCarriage_RTL = 52;
signed int offsetCarriage_LTR = 46;


volatile unsigned char knitPattern[255] = {
  0};
bool isKnitting = false;

//////////////////////////////////////////////////////////////////////////////
// Knitty Serial Protocol

// Receive commands
#define COM_CMD_PATTERN      'P'
#define COM_CMD_PATTERN_END  'E'
#define COM_CMD_CURSOR       'C'
#define COM_CMD_IFDR         'I'
#define COM_CMD_RESPONSE     'R'
#define COM_CMD_DIRECTION    'D'
#define COM_CMD_DEBUG        'V'
#define COM_CMD_NEW_PATTERN  'N'
#define COM_CMD_FIRST_NEEDLE 'F'  //first needle of pattern from right
#define COM_CMD_SEPERATOR    ':'

#define COM_CMD_SERVO        'S'

#define COM_CMD_PLOAD_END    '\n'

// Parser states
#define COM_PARSE_CMD      0x01
#define COM_PARSE_SEP      0x02
#define COM_PARSE_PLOAD    0x03


unsigned char parserState = COM_PARSE_CMD;

unsigned char parserReceivedCommand = 0;
String parserReceivedPayload = "";

unsigned char patternLength = 0;

void setup() {
  Serial.begin(115200);

  // Button Input
  pinMode(PIN_BUTTON_1, INPUT);

  //Eylet Input
  pinMode(PIN_Eyelet_1, INPUT);


  // Setup PHOTO SENSOR pin change interrupt
  pinMode(PIN_CSENSE, INPUT);
  pinMode(PIN_CREF, INPUT);
  attachInterrupt(INT_ENCODER, interruptPinChangeEncoder, CHANGE);

  // Setup IFDR pin change interrupt
  pinMode(PIN_IFDR, INPUT);
  attachInterrupt(INT_IFDR, interruptPinChangeIfdr, FALLING);

  // Setup Needles
  pinMode(PIN_NEEDLE_RTL, OUTPUT);
  digitalWrite(PIN_NEEDLE_RTL, HIGH);
  pinMode(PIN_NEEDLE_LTR, OUTPUT);
  digitalWrite(PIN_NEEDLE_LTR, HIGH);

}

void executeCommand(unsigned char cmd, String payload) {

  switch(cmd) {
  case COM_CMD_PATTERN:

    patternLength = payload.length();
    for(unsigned char i = 0; i < patternLength; i++) {
      knitPattern[i] = (payload.charAt(i) == '1')? 1 : 0;
    }

    break;

  case COM_CMD_CURSOR:
    currentCursorPosition = payload.toInt();
    break;

  case COM_CMD_FIRST_NEEDLE:
    firstNeedle = payload.toInt()*2-2;
    break;

  case COM_CMD_SERVO:

    switch(payload.toInt()) {
    case 0: //no colour selected
      servoColour12.write(90);
      servoColour34.write(90);
      break;
    case 1: //Color 1
      servoColour12.write(70);    
      servoColour34.write(90);
      break;    
    case 2: //Color 2
      servoColour12.write(115);
      servoColour34.write(90);
      break; 
    case 3: //Color 3
      servoColour12.write(90);    
      servoColour34.write(70);
      break;    
    case 4: //Color 4
      servoColour12.write(90);
      servoColour34.write(115);
      break; 
    case 5: //Servo off
      servoColour12.detach();
      servoColour34.detach();
      break; 
    case 6: //Servo on
      servoColour12.attach(8);
      servoColour34.attach(9);
      break; 
    }

    break;


  }
}

void sendCommand(unsigned char cmd, String payload) {
  Serial.write(cmd);
  Serial.write(COM_CMD_SEPERATOR);
  Serial.print(payload);
  Serial.write("\n");
}

void parserSerialStream() {

  if (Serial.available() == 0) {
    return;
  }

  char buffer = Serial.read();

  switch(parserState) {

  case COM_PARSE_CMD:
    parserState = COM_PARSE_SEP;
    parserReceivedCommand = buffer;
    parserReceivedPayload = "";
    break;

  case COM_PARSE_SEP:

    // We're awaiting a seperator here, if not, back to cmd
    if(buffer == COM_CMD_SEPERATOR) {
      parserState = COM_PARSE_PLOAD;
      break;
    }

    parserState = COM_PARSE_CMD;
    break;

  case COM_PARSE_PLOAD:

    if(buffer == COM_CMD_PLOAD_END) {

      executeCommand(parserReceivedCommand, parserReceivedPayload);
      parserState = COM_PARSE_CMD;

      sendCommand(COM_CMD_RESPONSE, "OK");
      break;
    }

    parserReceivedPayload += buffer;
    break;
  }
}

void loop() {
  parserSerialStream();

  //check if button for colour change ist activated and send response to processing
  button_1_State = digitalRead(PIN_BUTTON_1);

  if( buttonLastChecked == 0 ) // see if this is the first time checking the buttons
    buttonLastChecked = millis()+BUTTONDELAY;  // force a check this cycle
  if( millis() - buttonLastChecked > BUTTONDELAY ) { // make sure a reasonable delay passed
    if (button_1_State == HIGH) {    
      if (button_1_Hold == HIGH) { 
        // Send   
        sendCommand(COM_CMD_RESPONSE, "ON"); 
        button_1_Hold = LOW;
      }
    }
    else {
      if (button_1_Hold == LOW) { 
        // Send   
        sendCommand(COM_CMD_RESPONSE, "OFF"); 
        button_1_Hold = HIGH;
      }
    }
    buttonLastChecked = millis(); // reset the lastChecked value
  }



  //check Eyelets
  eyelet_1_State = digitalRead(PIN_Eyelet_1);

  if( eyelet_1_LastChecked == 0 ) // see if this is the first time checking the buttons
    eyelet_1_LastChecked = millis()+Eyelet_1_DELAY;  // force a check this cycle
  if( millis() - eyelet_1_LastChecked > Eyelet_1_DELAY ) { // make sure a reasonable delay passed
    if (eyelet_1_State == HIGH) {    
      if (eyelet_1_Hold == HIGH) { 
        // Send   
        sendCommand(COM_CMD_RESPONSE, "Eyelet 1 OUT"); 
        eyelet_1_Hold = LOW;
      }
    }
    else {
      if (eyelet_1_Hold == LOW) { 
        // Send   
        sendCommand(COM_CMD_RESPONSE, "Eyelet 1 IN"); 
        eyelet_1_Hold = HIGH;
      }
    }
    eyelet_1_LastChecked = millis(); // reset the lastChecked value
  }
}




void setNeedleByCursor(char cursorPosition) {

  // Just to be sure that we never exceed the pattern
  if(cursorPosition > patternLength-1 || cursorPosition < 0) {
    return;
  }

  if(currentDirection == DIRECTION_LEFT_RIGHT) {
    setNeedle_LTR(knitPattern[cursorPosition]);
  } 
  else if(currentDirection == DIRECTION_RIGHT_LEFT) {
    setNeedle_RTL(knitPattern[patternLength-cursorPosition-1]);
  }
}



void setNeedle_RTL(char state) {
  //change state because the E6000 sets needle by 0
  if(state==1){
    state = 0;
  }
  else
  {
    state = 1;
  }
  digitalWrite(PIN_NEEDLE_RTL, state);
}

void setNeedle_LTR(char state) {
  //change state because the E6000 sets needle by 0
  if(state==1){
    state = 0;
  }
  else
  {
    state = 1;
  }
  digitalWrite(PIN_NEEDLE_LTR, state);
}


void interruptPinChangeEncoder() {

  char currentPinChangeValue = digitalRead(PIN_CSENSE);
  char currentPinChangeOppositeValue = digitalRead(PIN_CREF);

  // Determine direction
  if(currentPinChangeValue == currentPinChangeOppositeValue) {
    currentDirection = DIRECTION_LEFT_RIGHT;
  } 
  else {
    currentDirection = DIRECTION_RIGHT_LEFT;
  }

  // RTL = 1, LTR = -1
  currentCursorPosition += currentDirection; 

  //store last position
  lastCursorPosition = currentCursorPosition;


  //debug cursorposition
  //sendCommand(COM_CMD_RESPONSE, String(currentCursorPosition));

  // Check if we're in range of our needles
  if((currentDirection == DIRECTION_RIGHT_LEFT && currentCursorPosition > offsetCarriage_RTL + firstNeedle) ||
    (currentDirection == DIRECTION_LEFT_RIGHT && currentCursorPosition - offsetCarriage_LTR  <= patternLength + firstNeedle)) {

    if(currentPatternIndex > patternLength) {

      setNeedle_RTL(0);
      setNeedle_LTR(0);
      currentPatternIndex = 0;
      isKnitting = false;

      sendCommand(COM_CMD_PATTERN_END, "1");


    } 
    else {

      if(isKnitting == true) {
        // React on FALLING Edge 
        if(currentPinChangeValue == 1)  {
          setNeedleByCursor(currentPatternIndex);
          currentPatternIndex++;
        }
      }

    }
  }

  if(lastDirection != currentDirection) {
    lastDirection = currentDirection;
    currentPatternIndex = 0;
    isKnitting = true;
    if(currentDirection == DIRECTION_RIGHT_LEFT) {
      sendCommand(COM_CMD_DIRECTION, "RTL");
    } 
    else {
      sendCommand(COM_CMD_DIRECTION, "LTR");
    }
  }
}

// We only use the IFDR to determine if we can send the pattern
// for the next line.
void interruptPinChangeIfdr() {
  if(isKnitting == false) {
    sendCommand(COM_CMD_IFDR, "1");
  }
}