Toberfra ba1d3a122d Funktion mit Endschalter
aber ohne Fehler Ueberwachung
2022-02-10 11:39:16 +01:00

65 lines
1.0 KiB
C++

#include "motor.h"
uint8_t Motor::pinPwm;
void Motor::setMotorPins(uint8_t pinA , uint8_t pinB){
this->pinA = pinA;
this->pinB = pinB;
}
void Motor::setMotorPwmPin(uint8_t pinPwm){
Motor::pinPwm = pinPwm;
}
void Motor::setup(){
ArduinoAnpassung::setup();
pinMode(pinPwm , OUTPUT);
digitalWrite(pinPwm , 1);
}
void Motor::memberSetup(){
pinMode(pinA , OUTPUT);
digitalWrite( pinA , 0);
pinMode(pinB , OUTPUT);
digitalWrite(pinB , 0);
}
void Motor::setMotorAktion(int8_t richtung){
if(richtung > 0){
digitalWrite( pinA , 1);
digitalWrite( pinB , 0);
digitalWrite(LED_BUILTIN , 1);
}else if(richtung < 0){
digitalWrite( pinA , 0);
digitalWrite( pinB , 1);
digitalWrite(LED_BUILTIN , 1);
}else{
digitalWrite( pinA , 0);
digitalWrite( pinB , 0);
digitalWrite(LED_BUILTIN , 0);
}
}
void Motor::setMotorAktion(int8_t richtung , int id ){
Motor *zeiger;
zeiger = (Motor*) searchIdElement(id);
if(zeiger)
zeiger->setMotorAktion(richtung);
}