SmartDrive40 controlled By Arduino Mega

Autonomous Robot, Manual Robot, DC Motor Driver, Stepper Motor Driver, Servo, Multi PWM chip.....

SmartDrive40 controlled By Arduino Mega

Postby roymeyismail » Fri Oct 24, 2014 4:29 pm

Why motor cannot rotate counter clockwise even i'm refer tutorial by cytron including the source code given??? Motor only rotate clockwise, for info i'm using ps2 controller to control clockwise and counter clockwise.
roymeyismail
Greenhorn
 
Posts: 3
Joined: Fri Oct 24, 2014 4:08 pm

Re: SmartDrive40 controlled By Arduino Mega

Postby yonghui » Fri Oct 24, 2014 5:43 pm

I think u will need to write more to explain.
try to take photo of your project setup.
post your code too.
thanks&regards,
yh
yonghui
Moderator
 
Posts: 732
Joined: Mon Sep 28, 2009 3:27 pm

Re: SmartDrive40 controlled By Arduino Mega

Postby roymeyismail » Mon Nov 03, 2014 4:07 pm

Code: Select all
#include <PS2X_lib.h>  //for v1.6
#include <Servo.h>
PS2X ps2x; // create PS2 Controller Class

//right now, the library does NOT support hot pluggable controllers, meaning
//you must always either restart your Arduino after you conect the controller,
//or call config_gamepad(pins) again after connecting the controller.
int error = 0;
byte type = 0;
byte vibrate = 0;

const int dir_1 = 22;
const int pwm_1 = 2;
const int dir_2 = 23;
const int pwm_2 = 3;

Servo myservo1;  // create servo object to control a servo
Servo myservo2;               // a maximum of eight servo objects can be created
 
int pos = 0;    // variable to store the servo position


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

 //CHANGES for v1.6 HERE!!! **************PAY ATTENTION*************
 
 error = ps2x.config_gamepad(13,11,10,12, true, true);   //setup pins and settings:  GamePad(clock, command, attention, data, Pressures?, Rumble?) check for error
 
 if(error == 0){
   Serial.println("Found Controller, configured successful");
   Serial.println("Try out all the buttons, X will vibrate the controller, faster as you press harder;");
  Serial.println("holding L1 or R1 will print out the analog stick values.");
  Serial.println("Go to www.billporter.info for updates and to report bugs.");
 
   
   pinMode(pwm_1, OUTPUT);
   pinMode(dir_1, OUTPUT);
   pinMode(dir_2, OUTPUT);
   pinMode(pwm_2, OUTPUT);

myservo1.attach(9);  // attaches the servo on pin 9 to the servo object
myservo2.attach(8);
 }
   
  else if(error == 1)
   Serial.println("No controller found, check wiring, see readme.txt to enable debug. visit www.billporter.info for troubleshooting tips");
   
  else if(error == 2)
   Serial.println("Controller found but not accepting commands. see readme.txt to enable debug. Visit www.billporter.info for troubleshooting tips");
   
  else if(error == 3)
   Serial.println("Controller refusing to enter Pressures mode, may not support it. ");
   
   //Serial.print(ps2x.Analog(1), HEX);
   
   type = ps2x.readType();
     switch(type) {
       case 0:
        Serial.println("Unknown Controller type");
       break;
       case 1:
        Serial.println("DualShock Controller Found");
       break;
       case 2:
         Serial.println("GuitarHero Controller Found");
       break;
     }
 
}

void loop(){
   /* You must Read Gamepad to get new values
   Read GamePad and set vibration values
   ps2x.read_gamepad(small motor on/off, larger motor strenght from 0-255)
   if you don't enable the rumble, use ps2x.read_gamepad(); with no values
   
   you should call this at least once a second
   */
   
   
   
 if(error == 1) //skip loop if no controller found
  return;
 
 if(type == 2){ //Guitar Hero Controller
   
   ps2x.read_gamepad();          //read controller
   
   if(ps2x.ButtonPressed(GREEN_FRET))
     Serial.println("Green Fret Pressed");
   if(ps2x.ButtonPressed(RED_FRET))
     Serial.println("Red Fret Pressed");
   if(ps2x.ButtonPressed(YELLOW_FRET))
     Serial.println("Yellow Fret Pressed");
   if(ps2x.ButtonPressed(BLUE_FRET))
     Serial.println("Blue Fret Pressed");
   if(ps2x.ButtonPressed(ORANGE_FRET))
     Serial.println("Orange Fret Pressed");
     

    if(ps2x.ButtonPressed(STAR_POWER))
     Serial.println("Star Power Command");
   
    if(ps2x.Button(UP_STRUM))          //will be TRUE as long as button is pressed
     Serial.println("Up Strum");
    if(ps2x.Button(DOWN_STRUM))
     Serial.println("DOWN Strum");
 
 
    if(ps2x.Button(PSB_START))                   //will be TRUE as long as button is pressed
         Serial.println("Start is being held");
    if(ps2x.Button(PSB_SELECT))
         Serial.println("Select is being held");

   
    if(ps2x.Button(ORANGE_FRET)) // print stick value IF TRUE
    {
        Serial.print("Wammy Bar Position:");
        Serial.println(ps2x.Analog(WHAMMY_BAR), DEC);
    }
 }

 else { //DualShock Controller
 
    ps2x.read_gamepad(false, vibrate);          //read controller and set large motor to spin at 'vibrate' speed
   
    if(ps2x.Button(PSB_START))                   //will be TRUE as long as button is pressed
         Serial.println("Start is being held");
    if(ps2x.Button(PSB_SELECT))
         Serial.println("Select is being held");
 
       
         
     if(ps2x.Button(PSB_PAD_UP)) {         //will be TRUE as long as button is pressed
       Serial.print("Up held this hard: ");
       Serial.println(ps2x.Analog(PSAB_PAD_UP), DEC);
       digitalWrite(dir_1,HIGH);
         analogWrite(pwm_1,100);
         digitalWrite(dir_2,HIGH);
         analogWrite(pwm_2,100);
         delay(200);
      }
      if(ps2x.Button(PSB_PAD_RIGHT)){
       Serial.print("Right held this hard: ");
        Serial.println(ps2x.Analog(PSAB_PAD_RIGHT), DEC);
        digitalWrite(dir_1,HIGH);
         analogWrite(pwm_1,100);
         digitalWrite(dir_2,LOW);
         analogWrite(pwm_2,50);
         delay(200); 
      }
      if(ps2x.Button(PSB_PAD_LEFT)){
       Serial.print("LEFT held this hard: ");
        Serial.println(ps2x.Analog(PSAB_PAD_LEFT), DEC);
        digitalWrite(dir_1,LOW);
         analogWrite(pwm_1,50);
         digitalWrite(dir_2,HIGH);
         analogWrite(pwm_2,100);
         delay(200);
      }
      if(ps2x.Button(PSB_PAD_DOWN)){
       Serial.print("DOWN held this hard: ");
     Serial.println(ps2x.Analog(PSAB_PAD_DOWN), DEC);
     digitalWrite(dir_1,LOW);
         analogWrite(pwm_1,100);
         digitalWrite(dir_2,LOW);
         analogWrite(pwm_2,100);

   
 
      }   
 
   
      vibrate = ps2x.Analog(PSAB_BLUE);        //this will set the large motor vibrate speed based on
                                              //how hard you press the blue (X) button   
   
    if (ps2x.NewButtonState())               //will be TRUE if any button changes state (on to off, or off to on)
    {
     
       
         
        if(ps2x.Button(PSB_L3))
         Serial.println("L3 pressed");
        if(ps2x.Button(PSB_R3))
         Serial.println("R3 pressed");
        if(ps2x.Button(PSB_L2))
         Serial.println("L2 pressed");
        if(ps2x.Button(PSB_R2))
         Serial.println("R2 pressed");
        if(ps2x.Button(PSB_GREEN))
         Serial.println("Triangle pressed");
         
    }   
         
   
    if(ps2x.Button(PSB_TRIANGLE)) {            //forward
         Serial.println("Circle just pressed");
         for(pos = 170; pos>=10; pos-=1)     // goes from 180 degrees to 0 degrees     
    myservo1.write(pos);    // tell servo to go to position in variable 'pos'
     delay(30);
    for(pos = 10; pos < 170; pos += 1)
    myservo2.write(pos);
    delay(30);                       // waits 15ms for the servo to reach the position   
    }     
    if(ps2x.Button(PSB_BLUE)) {            //reverse
         Serial.println("X just released");     
         for(pos = 10; pos < 170; pos += 1)  // goes from 0 degrees to 180 degrees
                                           // in steps of 1 degree
        myservo1.write(pos);              // tell servo to go to position in variable 'pos'
         delay(30);
        for(pos = 170; pos>=10; pos-=1)     // goes from 180 degrees to 0 degrees
        myservo2.write(pos);   
        delay(30);                       // waits 15ms for the servo to reach the position 
    }
    if(ps2x.Button(PSB_PINK))   {         //RIGHT
         Serial.println("Square just changed");
        delay(200);   
    }
      if(ps2x.Button(PSB_RED)){         //LEFT
         Serial.println("Circle pressed");
         delay(200);
      }
    if(ps2x.Button(PSB_L1) || ps2x.Button(PSB_R1)) // print stick values if either is TRUE
    {
        Serial.print("Stick Values:");
        Serial.print(ps2x.Analog(PSS_LY), DEC); //Left stick, Y axis. Other options: LX, RY, RX 
        Serial.print(",");
        Serial.print(ps2x.Analog(PSS_LX), DEC);
        Serial.print(",");
        Serial.print(ps2x.Analog(PSS_RY), DEC);
        Serial.print(",");
        Serial.println(ps2x.Analog(PSS_RX), DEC);
    }
   

 
     
}
 
 
 delay(50);
     
}
roymeyismail
Greenhorn
 
Posts: 3
Joined: Fri Oct 24, 2014 4:08 pm

Re: SmartDrive40 controlled By Arduino Mega

Postby roymeyismail » Mon Nov 03, 2014 4:26 pm

i'm followed PWM Single Channel,Sign-Magnitud Mode setup for each motor through SmartDrive40 Quick Start Guide
roymeyismail
Greenhorn
 
Posts: 3
Joined: Fri Oct 24, 2014 4:08 pm

Re: SmartDrive40 controlled By Arduino Mega

Postby ober » Mon Nov 03, 2014 10:11 pm

I think you should do try out the control of Smartdrive from Arduino mega, develop program to verify the working condition only, combining all the program will actually make the whole project difficult to be debug.
Ober Choo
Cytron Technologies Sdn Bhd
www.cytron.com.my
User avatar
ober
Moderator
 
Posts: 1352
Joined: Wed Apr 15, 2009 1:03 pm


Return to Robot Controller

Who is online

Users browsing this forum: No registered users and 4 guests