Go to Post I hope you realize that by starting this thread you have earned yourself a permanent place at the "WOEWITWISTFT" ("What On Earth Was I Thinking When I Started THAT FIRST Trend?") table. It's members are few, but the conversation is the most honest and amusing in the entire place. ;) - Jessica Boucher [more]
Home
Go Back   Chief Delphi > FIRST > General Forum
CD-Media   CD-Spy  
portal register members calendar search Today's Posts Mark Forums Read FAQ rules

 
 
 
Thread Tools Rate Thread Display Modes
Prev Previous Post   Next Post Next
  #1   Spotlight this post!  
Unread 20-02-2010, 04:43
mika.perlin mika.perlin is offline
Registered User
FRC #0955
 
Join Date: Jan 2010
Location: Corvallis, OR
Posts: 17
mika.perlin is an unknown quantity at this point
Mecanum Drive Not Working

So for some reason we can't get our mecanum drive working. Our code (in C++) looks like this:
Code:
[This just calculates the motor speeds which will be set later.
-myAbs(float) is just a function which finds the absolute value of a float.
-largest(float ...) is a function which finds the largest any number of inputted float values.
-these two functions have been tested and work correctly.]

   //Square Joystick inputs for better precision control
    x = mainStick.GetX(); x = x*x;
    y = mainStick.GetY(); y = y*y;
    twist = secondaryStick.GetX();
    //[0, 1] Throttle value which may be used to artificially decrease speed
    throttleFactor = -(mainStick.GetThrottle()-1)/2;
    //Set minimum threshold on Joystick inputs
    if(myAbs(x) + myAbs(y) + myAbs(twist) > JOY_THRESHOLD)
    {
    	//Calculate raw motor speeds for vector drive
        Speed[NW] = y + x + twist;    Speed[NE] = y - x - twist;
        Speed[SW] = y - x + twist;    Speed[SE] = y + x - twist;
        
        //Calculate magnitude of largest motor speed
        topSpeed = largest(myAbs(Speed[NW]), myAbs(Speed[NE]), myAbs(Speed[SW]), myAbs(Speed[SE]));
        
        //If the calculated largest speed is greater than 1, scale everything down
        if(topSpeed > 1)
        {
            Speed[NW] /= topSpeed;    Speed[NE] /= topSpeed;
            Speed[SW] /= topSpeed;    Speed[SE] /= topSpeed;
        }

        //Give option artificially slow down with throttle while holding down a button
        if (mainStick.GetRawButton(THROTTLE_BUTTON))
        {
            Speed[NW] *= throttleFactor;    Speed[NE] *= throttleFactor;
            Speed[SW] *= throttleFactor;    Speed[SE] *= throttleFactor;
        }
    }
    else  //If Joystick inputs not within threshold
    {
        Speed[NW] = 0;    Speed[NE] = 0;
        Speed[SW] = 0;    Speed[SE] = 0;
    }
We later set the motors in a separate function:
Code:
    //Invert motors in code instead of electronically
    NWMotor.Set(Speed[NW]*NW_MOTOR_INVERT);
    NEMotor.Set(Speed[NE]*NE_MOTOR_INVERT);
    SWMotor.Set(Speed[SW]*SW_MOTOR_INVERT);
    SEMotor.Set(Speed[SE]*SE_MOTOR_INVERT);
The motors do move, but in weird ways (for example if we push the main joystick full forward, I believe only two motors on opposite corners moved).
Also, if we put default code on the robot it does seem to make all of the motors move, but we don't want to use default code because we feel like it's cheating and it would just be nice to get our own code working so we can mess or with it or change it if we want.
So... anybody got any ideas?

Last edited by mika.perlin : 20-02-2010 at 04:45.
Reply With Quote
 


Thread Tools
Display Modes Rate This Thread
Rate This Thread:

Posting Rules
You may not post new threads
You may not post replies
You may not post attachments
You may not edit your posts

vB code is On
Smilies are On
[IMG] code is On
HTML code is Off
Forum Jump

Similar Threads
Thread Thread Starter Forum Replies Last Post
Tank Drive Not Working!!! live4u2 NI LabVIEW 2 05-02-2010 20:40
crab drive vs. mecanum drive system superbotman Technical Discussion 33 06-01-2010 03:09
Drive code not working; any suggestions? BrandonD-1528 Programming 9 30-01-2009 21:06
pic: Jester Drive:Mecanum Wheel Drive Train Ken Delaney 357 Technical Discussion 64 29-03-2006 22:16


All times are GMT -5. The time now is 08:24.

The Chief Delphi Forums are sponsored by Innovation First International, Inc.


Powered by vBulletin® Version 3.6.4
Copyright ©2000 - 2017, Jelsoft Enterprises Ltd.
Copyright © Chief Delphi