Motor control with TB6612 + Arduino

Other Hardware Motors, Mechanics, Power and CNC
4

I have made code and wiring

#define PWMA 3  
#define AIN1 5
#define AIN2 4
#define PWMB 10  
#define BIN1 8
#define BIN2 9
#define STBY 7  
#define Voltage A0 

int PwmA, PwmB;
double V;

void setup() {
  pinMode(AIN1, OUTPUT);
  pinMode(AIN2, OUTPUT);
  pinMode(BIN1, OUTPUT);
  pinMode(BIN2, OUTPUT);
  pinMode(PWMA, OUTPUT);
  pinMode(PWMB, OUTPUT);
  pinMode(STBY, OUTPUT);
  
  digitalWrite(AIN1, 1);
  digitalWrite(AIN2, 0);
  digitalWrite(BIN1, 1);
  digitalWrite(BIN2, 0);
  digitalWrite(STBY, 1);
  analogWrite(PWMA, 0);
  analogWrite(PWMB, 0);

  Serial.begin(9600);
  pinMode(Voltage,INPUT);

void SetPWM(int motor, int pwm)
{
  if(motor==1&&pwm>=0)
  {
    digitalWrite(AIN1, 1);
    digitalWrite(AIN2, 0);
    analogWrite(PWMA, pwm);
  }
  else if(motor==1&&pwm<0)
  {
    digitalWrite(AIN1, 0);
    digitalWrite(AIN2, 1);
    analogWrite(PWMA, -pwm);
  }
  else if(motor==2&&pwm>=0)
  {
    digitalWrite(BIN1, 0);
    digitalWrite(BIN2, 1);
    analogWrite(PWMB, pwm);
  }
  else if(motor==2&&pwm<0)
  {
    digitalWrite(BIN1, 1);
    digitalWrite(BIN2, 0);
    analogWrite(PWMB, -pwm);
  }
}

void loop() 
{
  SetPWM(1, 255);
  SetPWM(2, 255);
  V=analogRead(Voltage); 
  Serial.print(V*0.05371);  
  Serial.println("V");
  delay(500);//
}

frw
frw1920×1075 143 KB