Friday, August 26, 2011

Motor Drivers: 1A Dual TB6612FNG Part 2

Since the last motor driver post I've cleaned up a lot of the wiring and platform mess.


Instead of having to wire my battery pack supply pins into Vin, I can plug them directly into the Arduino's power adapter. I soldered a barrel jack onto the 9-volt battery adapter and covered the connection in heat-shrink tubing to prevent any mishaps. Not only is it easier to connect to the Arduino, but it keeps everything a lot more clean.

8 x 1.2V Rayovac 4.0 NiMH Batteries
I also upgraded the shipping box to a larger model. More space for the batteries and electronics. This will serve for testing purposes until I get to design and cut out an actual platform in my robotics class.

This is what happens when you order more stuff, bigger box for projects.
Plastic geared motors with matching sumo wheels

Since the robot will be driven by two wheels, I'll need a caster to help keep it balanced. Replaced the guitar pick with an actual metal caster ball.

http://www.sparkfun.com/products/8909
You can sort of see the motor driver in there. I need to get another spool of wire to make longer jumpers
As far as the code goes, I've added LCD feedback that will tell you what the motors are doing (direction and speed).

No the arduino isn't going to hang out of the box, it's just for show!

Enough talk, let's see it in action:

 
The digital camera can record sound, unlike my cellphone.

 
Made a quick change to the code and didn't want to re-record the first video!

Here is the code from the demo video:
Once again, this code is made specifically for the 1A Dual TB6612FNG motor driver. 

//  Noah Stahl
//  8/25/2011
//  http://arduinomega.blogspot.com
//  Arduino Mega 2560
//This sketch is used to control the TB6612FNG Motor Driver.
//The Motor Driver is controlling two bidirectional DC Motors, A and B.
//There are four states for each motor in this code: STANDBY, BRAKE, CW, CCW.
//The speed of the motors can be controlled through PWM. 0 for stopped and
//255 for full-speed.

//!!!READ-ME!!!
//Depending on the placement and wiring of your motors, this code may not work
//as intended on your project. YMMV! You can fix any of the wrong directions by
//changing the FORWARD, REVERSE, RIGHT, and LEFT define values below.
//You will also have to do a little experimenting to determine a good delay
//value for turning. This value is going to change depending on your motor speed,
//torque, surface material, battery voltage, and a whole bunch of other variables
//that you will probably be unable to account for. Just use a good guess.
// LCD Vss(1) to GND
// LCD Vdd(2) to +5V
// LCD Vo (3) to +5V (contrast control)
// LCD RS (4) to digital pin 43
// LCD R/W(5) to GND
// LCD EN (6) to digital pin 42
// LCD D4 (7) to digital pin 40
// LCD D5 (8) to digital pin 39
// LCD D6 (9) to digital pin 38
// LCD D7 (10)to digital pin 37

#include <LiquidCrystal.h>
// Specify the numbers of the LCD pins on the Arduino
LiquidCrystal lcd(43, 42, 40, 39, 38, 37); // RS, EN, D4, D5, D6, D7

#define PWMA 2
#define AIN1 53
#define AIN2 52
#define BIN1 51
#define BIN2 50
#define PWMB 3
#define STBY 49
#define motor_A 0
#define motor_B 1
#define FORWARD 1
#define REVERSE 0
#define RIGHT 1
#define LEFT 0

void setup()
{
  pinMode(PWMA,OUTPUT);
  pinMode(AIN1,OUTPUT);
  pinMode(AIN2,OUTPUT);
  pinMode(PWMB,OUTPUT);
  pinMode(BIN1,OUTPUT);
  pinMode(BIN2,OUTPUT);
  pinMode(STBY,OUTPUT);
 
  lcd.begin(20, 2);         // Number of columns and rows on the LCD
  lcd.println("ArduinoMega Blagspot");
  lcd.setCursor(0,1);
  lcd.println("    Motor Driver    ");
  delay(5000);
  lcd.clear();
  motor_standby(false);        //Must set STBY pin to HIGH in order to move
}

void loop()
{
  motor_brake();               //STOP for 1s
  delay(1000);
 
  motor_drive(FORWARD, 255);   //Move FORWARD at full speed for 1s
  delay(1000);
 
  motor_brake();               //STOP for 1s
  delay(1000);

  motor_drive(REVERSE, 150);   //REVERSE at about half-speed for 1s
  delay(1000);
 
  motor_brake();               //STOP for 1s
  delay(1000);
 
  motor_turn(RIGHT, 255, 255); //Spin RIGHT for 0.5s
  delay(500);
}

//Turns off the outputs of the Motor Driver when true
void motor_standby(char standby)
{
  if (standby == true) digitalWrite(STBY,LOW);
  else digitalWrite(STBY,HIGH);
  lcd.clear();
  lcd.setCursor(0,0);
  lcd.print("MOTOR ON");
}

//Stops the motors from spinning and locks the wheels
void motor_brake()
{
  digitalWrite(AIN1,1);
  digitalWrite(AIN2,1);
  digitalWrite(PWMA,LOW);
  digitalWrite(BIN1,1);
  digitalWrite(BIN2,1);
  digitalWrite(PWMB,LOW);
  lcd.clear();
  lcd.setCursor(0,0);
  lcd.print("STOP");
}

//Control the direction the motors turn, speed from 0(off) to 255(full speed)
void motor_drive(char direction, unsigned char speed)
{
  if (direction == FORWARD)
  {
    motor_control(motor_A, FORWARD, speed);
    motor_control(motor_B, FORWARD, speed);
    lcd.clear();
    lcd.setCursor(0,0);
    lcd.print("FORWARD");
    lcd.setCursor(0,1);
    lcd.print("Speed: ");
    lcd.print((int)speed);
  }
  else
  {
    motor_control(motor_A, REVERSE, speed);
    motor_control(motor_B, REVERSE, speed);
    lcd.clear();
    lcd.setCursor(0,0);
    lcd.print("REVERSE");
    lcd.setCursor(0,1);
    lcd.print("Speed: ");
    lcd.print((int)speed);
  }
}

//You can control the turn radius by specifying the speed of each motor
//Set both to 255 for it to spin in place
void motor_turn(char direction, unsigned char speed_A, unsigned char speed_B )
{
  if (direction == RIGHT)
  {
    motor_control(motor_A, REVERSE, speed_A);
    motor_control(motor_B, FORWARD, speed_B);
    lcd.clear();
    lcd.setCursor(0,0);
    lcd.print("RIGHT");
    lcd.setCursor(0,1);
    lcd.print("Speed: ");
    lcd.print((int)speed_A);
  }
  else
  {
    motor_control(motor_A, FORWARD, speed_A);
    motor_control(motor_B, REVERSE, speed_B);
    lcd.clear();
    lcd.setCursor(0,0);
    lcd.print("LEFT");
    lcd.setCursor(0,1);
    lcd.print("Speed: ");
    lcd.print((int)speed_A);
  }
}

void motor_control(char motor, char direction, unsigned char speed)
{
  if (motor == motor_A)
  {
    if (direction == FORWARD)
    {
      digitalWrite(AIN1,HIGH);
      digitalWrite(AIN2,LOW);
    }
    else
    {
      digitalWrite(AIN1,LOW);
      digitalWrite(AIN2,HIGH);
    }
    analogWrite(PWMA,speed);
  }
  else
  {
    if (direction == FORWARD)  //Notice how the direction is reversed for motor_B
    {                          //This is because they are placed on opposite sides
      digitalWrite(BIN1,LOW);  //To go FORWARD, motor_A spins CW and motor_B spins CCW
      digitalWrite(BIN2,HIGH);
    }
    else
    {
      digitalWrite(BIN1,HIGH);
      digitalWrite(BIN2,LOW);
    }
    analogWrite(PWMB,speed);
  }
}


When it comes time to build my robot, I am most likely going to need to upgrade my plastic motors to metal gearmotors. I'd hate to have the plastic gears fail in the middle of a demonstration. As long as I can keep the current for each motor under 1.2A continuous and 3A peak, I will be able to still use this motor driver and the code.

Thursday, August 25, 2011

Measuring Feedback: Analog Joystick and LCD

If you remember from my last update, I accidentally fried the ATmega USB chip on my Arduino. Since this chip controls the COM port communications, I can no longer use the serial monitor for easy feedback. From now on it looks like I'm going to be stuck using an LCD (Liquid Crystalline Display) which I've been meaning to set up for some time now. Thankfully it's just as easy to control due to all of the built in program libraries.

Your Arduino isn't going to always be attached to a computer so its a good idea to have some other form of visual feedback besides the serial monitor. This is where your LCD comes in handy. It makes your project look cooler and allows you to debug and get some feedback from your program while disconnected from your computer.

I really should look into getting a back lit LCD, cooler looking AND easier to read
Even though a robot should be fully autonomous, its always helpful to have some form of control during the building and testing stages. During my last Sparkfun splurge, I picked up a thumb joystick and it's breakout board. http://www.sparkfun.com/products/9032

Thumb joystick plus breakout board
If you've ever played a vidya game post year 2000, you've probably come into contact with one of these before. This joystick is two-dimensional and has a breakout pin for each of the horizontal and vertical (X and Y) axis. Being an analog joystick, movements are measured using two potentiometers, one for up/down the other for left/right. Each directional axis is mapped to a 10K potentiometer so we're going to need to use the analogRead function to get our values.

 Wow that microphone is sensitive... my nose is stuffy, big whoop wanna fight about it?

Here's the code I used from the video:

//  Noah Stahl
//  http://arduinomega.blogspot.com
//  Arduino Mega 2560
//This sketch continuously measures the vertical and horizontal
//positions of a thumb joystick and displays the results on an LCD.
//This code assumes that you are using a 20x2 LCD with 4-bit data
// LCD Vss(1) to GND
// LCD Vdd(2) to +5V
// LCD Vo (3) to +5V (contrast control)
// LCD RS (4) to digital pin 53
// LCD R/W(5) to GND
// LCD EN (6) to digital pin 52
// LCD D4 (7) to digital pin 50
// LCD D5 (8) to digital pin 49
// LCD D6 (9) to digital pin 48
// LCD D7 (10)to digital pin 47


#include <LiquidCrystal.h>
// Specify the numbers of the LCD pins on the Arduino
LiquidCrystal lcd(53, 52, 50, 49, 48, 47); // RS, EN, D4, D5, D6, D7
 
void setup()
{
  lcd.begin(20, 2);         // Number of columns and rows on the LCD
  lcd.clear();
  lcd.println("ArduinoMega Blagspot");
  lcd.setCursor(0,1);
  lcd.println("Thumb Joystick Test ");
  delay(5000);
  lcd.clear();
}
 
void loop()
{
  lcd.setCursor(0,0);
  lcd.print("Horizontal: ");
  lcd.print(analogRead(1));  // HORZ pin connected to A1
  lcd.setCursor(0,1);
  lcd.print("  Vertical: ");
  lcd.print(analogRead(0));  // VERT pin connected to A0
  delay(100);                // Prevents LCD from updating too quickly
  lcd.clear();
}

You might have noticed that the horizontal centers at 525 instead of 512. Since it is consistent you could easily adapt your code to accommodate this.

The analog values will also max/minimize out before the joystick actually reaches its full range of motion. These dead spots are close enough to the edges that it shouldn't be a problem for your project. There is also an extra pin on the breakout board for the built in tactile switch which I didn't utilize in this demo. For less than $4, can you really complain? (Don't answer that...) Once I get around to setting up my Xbees with the Arduino, this would be perfect for a remote control. For another update though!

I Need a Medic Here!


Clear! *BZZRT* You'll live buddy, now get back to the fight!

YOU WANT SUMMA THIS?

I swear this blag isn't dead... at least not anymore! I didn't have as much free time this summer as I was hoping for and started a number of posts that have yet to be finished: Joystick, Breaduino, Xbee, Servo Pan/Tilt, etc... Since classes have started, I will most likely be updating this blag a lot more frequently (weekly?) with my robotics findings.

I set up a separate blog for the class, but will only be posting reports and multimedia specific to the robot there. I'll still be using this blag for research and whatnot.

Also, just got a digital camera from Amazon. Nothing special, but expect to see clearer pictures and video from now on. If you're really lucky, I might just go back and update the old pictures and videos as well!

Maybe...