Beiträge von Commerzpunk

int motorPin = 12;

void setup() {
   pinMode(motorPin, OUTPUT);
   Serial.begin(115200);
   while (! Serial);
   Serial.println("Speed 0 to 255");
}

void loop() {
   if (Serial.available()) {
      int speed = Serial.parseInt();
      if (speed >= 0 && speed <= 255) {
         analogWrite(motorPin, speed);
      }
   }
}

//display
#include <Adafruit_GFX.h>  // Include core graphics library for the display
#include <Adafruit_SSD1306.h>  // Include Adafruit_SSD1306 library to drive the display

Adafruit_SSD1306 display(128, 64);  // Create display

#include <Fonts/FreeMonoBold12pt7b.h>  // Add a custom font
#include <Fonts/FreeMono9pt7b.h>  // Add a custom font

//display

int intRead = 0;
int intProzent = 0;
int intProzentOld = 0;
int intWarten = 0;

bool blnDirection = false;
bool running = false;
float status;


const int phase1pin = 3;
const int phase2pin = 5;
const int phase3pin = 6;

float holdTime;
float targetSpeed;

unsigned long p1start,
         p1end,
         p2start,
         p2end,
         p3start,
         p3end;

// Change these until you find your min and max speeds.
float min = 3200;
float max = 50000;

void setup() {
  Serial.begin(115200);
  pinMode(phase1pin, OUTPUT);
  pinMode(phase2pin, OUTPUT);
  pinMode(phase3pin, OUTPUT);

  //display
  delay(100);  // This delay is needed to let the display to initialize
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);  // Initialize display with the I2C address of 0x3C
  display.clearDisplay();  // Clear the buffer
  display.setTextColor(WHITE);  // Set color of the text
  display.setRotation(0);  // Set orientation. Goes from 0, 1, 2 or 3
  display.setTextWrap(false);  // By default, long lines of text are set to automatically “wrap” back to the leftmost column.
  // To override this behavior (so text will run off the right side of the display - useful for
  // scrolling marquee effects), use setTextWrap(false). The normal wrapping behavior is restored
  // with setTextWrap(true).
  display.dim(1);  //Set brightness (0 is maximun and 1 is a little dim)
  //display
}


void chkP1(int pin) {
  unsigned long currentTime = micros();
  unsigned long td = currentTime - p1start;
  unsigned long refractory = 2.25 * holdTime;
  if (digitalRead(pin)) {
    if (td > holdTime) {
      digitalWrite(pin, LOW);
      p1end = currentTime;
    }
  } else if (td > refractory) {
    digitalWrite(pin, HIGH);
    p1start = currentTime;
  }
}

void chkP2(int pin) {
  unsigned long currentTime = micros();
  unsigned long td = currentTime - p1start;
  if (digitalRead(pin)) {
    if (td > 1.75 * holdTime || td < 0.75 * holdTime) {
      digitalWrite(pin, LOW);
      p2end = currentTime;
    }
  } else if (td > 0.75 * holdTime && td < 1.75 * holdTime) {
    digitalWrite(pin, HIGH);
    p2start = currentTime;
  }
}

void chkP3(int pin) {
  unsigned long currentTime = micros();
  unsigned long td = currentTime - p1start;
  if (digitalRead(pin)) {
    if (td > 0.25 * holdTime && p3start < p1start) {
      digitalWrite(pin, LOW);
      p3end = currentTime;
    }
  } else if (td > 1.5 * holdTime) {
    digitalWrite(pin, HIGH);
    p3start = currentTime;
  }
}

void setupMotor(float input_targetSpeed, bool blnDirection_new)
{
  // Converts the percent value into something usable
  targetSpeed = max - ((max - min) * (input_targetSpeed * 0.01));
  Serial.println(input_targetSpeed);
  Serial.println(targetSpeed);
  // See if the direction has changed
  if (blnDirection_new != blnDirection)
  {
    Serial.println("CHANGE DIR");
    holdTime = 20000;
    blnDirection = blnDirection_new;
    // Wait for it to stop, weird things can happen if it's still moving.
    delay(500);

    // Initialize first phase
    if (blnDirection == true)
    {
      digitalWrite(phase1pin, HIGH);
    }
    else if (blnDirection == false)
    {
      digitalWrite(phase3pin, HIGH);
    }
  }

  running = true;
}

void ifrunning() {
  if (running) {

    if (blnDirection == true)
    {
      chkP1(phase3pin);
      chkP2(phase2pin);
      chkP3(phase1pin);
    }
    else if (blnDirection == false)
    {
      chkP1(phase1pin);
      chkP2(phase2pin);
      chkP3(phase3pin);
    }

    delayMicroseconds(100);

    if (holdTime > targetSpeed)
    {
      holdTime -= 0.5;
    }
    else if (holdTime < targetSpeed)
    {
      holdTime += 0.25;
    }

    // Monitors the current speed
    status = -(holdTime - max) / ((max - min) * (0.01));

    if (status == 100)
    {
      // setupMotor(100, "reverse");
    }
  }
}

void loop() {
  intWarten = intWarten + 1;
  if (intWarten > 1000) {
    ifrunning();
    intRead = analogRead(2);    // read the value from the sensor
    intProzent = (intRead) * 100L / (720);
    ifrunning();
    intWarten = 0;
  }

  if (abs(intProzentOld - intProzent) >= 10 ) {
    ifrunning();
    intProzent = intProzent / 10;
    intProzent = round(intProzent);
    intProzent = intProzent * 10;

    intProzentOld = intProzent;
    String StrProzent = " %";
    String StrProzentText = intProzent + StrProzent;

    float input_targetSpeed = float(intProzent);
    String new_direction = "forward";
    bool blnDirection_new = true;

    setupMotor(input_targetSpeed, blnDirection_new);

    ifrunning();
    display.clearDisplay();  // Clear the display so we can refresh
    ifrunning();

    display.setFont(&FreeMono9pt7b);  // Set a custom font
    display.setTextSize(0);  // Set text size. We are using a custom font so you should always use the text size of 0

    // Print text:
    display.setCursor(0, 10);  // (x,y)
    display.println("Motor-");  // Text or value to print
    display.setCursor(0, 25);  // (x,y)
    display.println("leistung:");  // Text or value to print
    display.setCursor(0, 50);  // (x,y)
    display.println("    " + StrProzentText);  // Text or value to print

    display.drawRoundRect(14, 59, 100, 5, 5, WHITE);
    display.fillRoundRect(14, 59, intProzent, 5, 5, WHITE);
    ifrunning();

    display.display();  // Print everything we set previously
    ifrunning();
  }

  ifrunning();

}

const int phase1pin = 3;
const int phase2pin = 5;
const int phase3pin = 6;

float holdTime; 
float targetSpeed;
 
unsigned long p1start,
              p1end,
              p2start,
              p2end,
              p3start,
              p3end;
              
// Change these until you find your min and max speeds.
float min = 3200;
float max = 50000;

void setup() {
  Serial.begin(115200);
  pinMode(phase1pin, OUTPUT);
  pinMode(phase2pin, OUTPUT);
  pinMode(phase3pin, OUTPUT);
}

String direction;
bool running = false;
float status;

void chkP1(int pin){
  unsigned long currentTime = micros();
  unsigned long td = currentTime - p1start;
  unsigned long refractory = 2.25*holdTime;
  if(digitalRead(pin)){
    if(td > holdTime){
      digitalWrite(pin, LOW);
      p1end = currentTime;
    }
  }else if(td > refractory){
    digitalWrite(pin, HIGH);
    p1start = currentTime;
  }
}
 
void chkP2(int pin){
  unsigned long currentTime = micros();
  unsigned long td = currentTime - p1start;
  if(digitalRead(pin)){
    if(td > 1.75*holdTime || td < 0.75*holdTime){
      digitalWrite(pin, LOW);
      p2end = currentTime;
    }
  }else if(td > 0.75*holdTime && td < 1.75*holdTime){
    digitalWrite(pin, HIGH);
    p2start = currentTime;
  }
}
 
void chkP3(int pin){
  unsigned long currentTime = micros();
  unsigned long td = currentTime - p1start;
  if(digitalRead(pin)){
    if(td > 0.25*holdTime && p3start < p1start){
      digitalWrite(pin, LOW);
      p3end = currentTime;
    }
  }else if(td > 1.5*holdTime){
    digitalWrite(pin, HIGH);
    p3start = currentTime;
  }
}

void setupMotor(float input_targetSpeed, String new_direction)
{
  // Converts the percent value into something usable
  targetSpeed = max-((max-min)*(input_targetSpeed*0.01));

Serial.println(input_targetSpeed);
Serial.println(targetSpeed);
  // See if the direction has changed
  if(new_direction != direction)
  {
    Serial.println("CHANGE DIR");
    holdTime = 20000;
    direction = new_direction;
    // Wait for it to stop, weird things can happen if it's still moving.
    delay(500);

    // Initialize first phase
    if(direction == "forward")
    {
      digitalWrite(phase1pin, HIGH);
    }
    else if(direction == "reverse")
    {
      digitalWrite(phase3pin, HIGH);
    }
  }
  
  running = true;
}
 
void loop(){

  if(Serial.available() > 0) 
  {
    // Read serial input ex. "100 reverse" or "50 forward"
    float input_targetSpeed = Serial.readStringUntil(' ').toInt();
  
    //Serial.read(); //next character is space, so skip it using this
    String new_direction = Serial.readStringUntil('\n');
    setupMotor(input_targetSpeed, new_direction);
  }
  
  if(running) {
  
    if(direction == "forward")
    {
        chkP1(phase3pin);
        chkP2(phase2pin);
        chkP3(phase1pin); 
    }
    else if(direction == "reverse")
    {
        chkP1(phase1pin);
        chkP2(phase2pin);
        chkP3(phase3pin);
    }
    
    delayMicroseconds(100);
   
    if(holdTime > targetSpeed)
    {
      holdTime -= 0.5;
    }
    else if(holdTime < targetSpeed)
    {
      holdTime += 0.25;
    }

    // Monitors the current speed
    status = -(holdTime-max)/((max-min)*(0.01));
    
    if(status == 100)
    {
       // setupMotor(100, "reverse");
    }
  }
    
}

//display
#include <Adafruit_GFX.h>  // Include core graphics library for the display
#include <Adafruit_SSD1306.h>  // Include Adafruit_SSD1306 library to drive the display

Adafruit_SSD1306 display(128, 64);  // Create display

#include <Fonts/FreeMonoBold12pt7b.h>  // Add a custom font
#include <Fonts/FreeMono9pt7b.h>  // Add a custom font

//display

int intRead = 0;
int intProzent = 0;
int intProzentOld = 0;


const int phase1pin = 3;
const int phase2pin = 5;
const int phase3pin = 6;

float holdTime; 
float targetSpeed;
 
unsigned long p1start,
              p1end,
              p2start,
              p2end,
              p3start,
              p3end;
              
// Change these until you find your min and max speeds.
float min = 3200;
float max = 50000;

void setup() {
  Serial.begin(115200);
  pinMode(phase1pin, OUTPUT);
  pinMode(phase2pin, OUTPUT);
  pinMode(phase3pin, OUTPUT);

//display
  delay(100);  // This delay is needed to let the display to initialize
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);  // Initialize display with the I2C address of 0x3C
  display.clearDisplay();  // Clear the buffer
  display.setTextColor(WHITE);  // Set color of the text
  display.setRotation(0);  // Set orientation. Goes from 0, 1, 2 or 3
  display.setTextWrap(false);  // By default, long lines of text are set to automatically “wrap” back to the leftmost column.
                               // To override this behavior (so text will run off the right side of the display - useful for
                               // scrolling marquee effects), use setTextWrap(false). The normal wrapping behavior is restored
                               // with setTextWrap(true).
  display.dim(1);  //Set brightness (0 is maximun and 1 is a little dim)
 //display
}

String direction;
bool running = false;
float status;

void chkP1(int pin){
  unsigned long currentTime = micros();
  unsigned long td = currentTime - p1start;
  unsigned long refractory = 2.25*holdTime;
  if(digitalRead(pin)){
    if(td > holdTime){
      digitalWrite(pin, LOW);
      p1end = currentTime;
    }
  }else if(td > refractory){
    digitalWrite(pin, HIGH);
    p1start = currentTime;
  }
}
 
void chkP2(int pin){
  unsigned long currentTime = micros();
  unsigned long td = currentTime - p1start;
  if(digitalRead(pin)){
    if(td > 1.75*holdTime || td < 0.75*holdTime){
      digitalWrite(pin, LOW);
      p2end = currentTime;
    }
  }else if(td > 0.75*holdTime && td < 1.75*holdTime){
    digitalWrite(pin, HIGH);
    p2start = currentTime;
  }
}
 
void chkP3(int pin){
  unsigned long currentTime = micros();
  unsigned long td = currentTime - p1start;
  if(digitalRead(pin)){
    if(td > 0.25*holdTime && p3start < p1start){
      digitalWrite(pin, LOW);
      p3end = currentTime;
    }
  }else if(td > 1.5*holdTime){
    digitalWrite(pin, HIGH);
    p3start = currentTime;
  }
}

void setupMotor(float input_targetSpeed, String new_direction)
{
  // Converts the percent value into something usable
  targetSpeed = max-((max-min)*(input_targetSpeed*0.01));
Serial.println(input_targetSpeed);
Serial.println(targetSpeed);
  // See if the direction has changed
  if(new_direction != direction)
  {
        Serial.println("CHANGE DIR");
    holdTime = 20000;
    direction = new_direction;
    // Wait for it to stop, weird things can happen if it's still moving.
    delay(500);

    // Initialize first phase
    if(direction == "forward")
    {
      digitalWrite(phase1pin, HIGH);
    }
    else if(direction == "reverse")
    {
      digitalWrite(phase3pin, HIGH);
    }
  }
  
  running = true;
}


void loop(){
intRead = analogRead(2);    // read the value from the sensor

intProzent = (intRead)*100L/(720);

if(abs(intProzentOld - intProzent) >= 10 ) {

intProzent = intProzent / 10;
intProzent = round(intProzent);
intProzent = intProzent * 10;

intProzentOld = intProzent;
String StrProzent = " %";
String StrProzentText = intProzent + StrProzent;

float input_targetSpeed = float(intProzent);
String new_direction = "forward";
setupMotor(input_targetSpeed, new_direction);


  display.clearDisplay();  // Clear the display so we can refresh

  display.setFont(&FreeMono9pt7b);  // Set a custom font
  display.setTextSize(0);  // Set text size. We are using a custom font so you should always use the text size of 0

  // Print text:
  display.setCursor(0, 10);  // (x,y)
  display.println("Motor-");  // Text or value to print
  display.setCursor(0, 25);  // (x,y)
  display.println("leistung:");  // Text or value to print
  display.setCursor(0, 50);  // (x,y)
  display.println("    " + StrProzentText);  // Text or value to print

display.drawRoundRect(14, 59, 100, 5, 5, WHITE);
display.fillRoundRect(14, 59, intProzent, 5, 5, WHITE); 

display.display();  // Print everything we set previously  
}




  if(running) {
  
    if(direction == "forward")
    {
        chkP1(phase3pin);
        chkP2(phase2pin);
        chkP3(phase1pin); 
    }
    else if(direction == "reverse")
    {
        chkP1(phase1pin);
        chkP2(phase2pin);
        chkP3(phase3pin);
    }
    
    delayMicroseconds(100);
   
    if(holdTime > targetSpeed)
    {
      holdTime -= 0.5;
    }
    else if(holdTime < targetSpeed)
    {
      holdTime += 0.25;
    }

    // Monitors the current speed
    status = -(holdTime-max)/((max-min)*(0.01));
    
    if(status == 100)
    {
       // setupMotor(100, "reverse");
    }
  }
  

}