Chief Delphi - Mecanum Java Code

Chief Delphi (http://www.chiefdelphi.com/forums/index.php)

- Java (http://www.chiefdelphi.com/forums/forumdisplay.php?f=184)

- - Mecanum Java Code (http://www.chiefdelphi.com/forums/showthread.php?t=148187)

rlounds

05-04-2016 04:45 PM

Mecanum Java Code

Hi, so on my teams demo robot we're using mecanum wheels, a 4 slot cRIO and some victor 884s and we cant seem to get it working right. I don't know that much about code so it'd be great if I could get some help.

The code can be found below, any suggestions/correction are very much appreciated.

Code:

package edu.wpi.first.wpilibj.templates;

import edu.wpi.first.wpilibj.Joystick;

import edu.wpi.first.wpilibj.RobotDrive;

import edu.wpi.first.wpilibj.SimpleRobot;

import edu.wpi.first.wpilibj.Timer;

import edu.wpi.first.wpilibj.Victor;



public class RobotTemplate extends SimpleRobot {



    RobotDrive myDrive;

    Joystick driveStick;

    

    public void robotInit() {

        driveStick = new Joystick(1);

        Victor frontLeft = new Victor(1);

        Victor frontRight = new Victor(2);

        Victor rearLeft = new Victor(3);

        Victor rearRight = new Victor(4);

        myDrive = new RobotDrive(frontLeft, rearLeft, frontRight, rearRight);

        System.out.println("Sample Text");

    }

    

    public void autonomous() {

        

    }



    public void operatorControl() {

        while (isOperatorControl() && isEnabled()) {

            myDrive.mecanumDrive_Cartesian(driveStick.getX(), driveStick.getY(), driveStick.getTwist(), 0);

            Timer.delay(0.01);

      

        }

    }

    

    public void test() {

    

    }

}

Ben Wolsieffer

05-04-2016 05:01 PM

Re: Mecanum Java Code

What problems are you having with it? Are you getting errors? Does the robot move at all?

Quickly looking it over I don't see any problems.

rlounds

05-04-2016 06:16 PM

Re: Mecanum Java Code

3 of our wheels don't go in the same direction and one doesn't move unless told to turn on the spot. Tried swapping some PWMs and that didn't help. I'm also not getting any errors with the code either...

Ben Wolsieffer

05-04-2016 06:48 PM

Re: Mecanum Java Code

First, I would make sure you have the PWMs mapped correctly. If you are sure these are correct, it will make debugging everything else much easier.

Also, if you haven't already, put the robot on blocks so you can see what the motors are doing without having it try to drive around.

My guess is that you need to invert some of the motors. You can do this either in code (using myDrive.setInvertedMotor()), or by reversing the polarity of the wires that go from the Victor to the motor. When you push the joystick forward, all the wheels should move. If they don't you either have a problem with your joystick axes (what joystick are you using?) or your motor controller. Once all 4 wheels are moving when you command the robot to go forward, invert all the ones that are going backwards.

Ether

05-04-2016 08:07 PM

Re: Mecanum Java Code

Quote:

Originally Posted by lopsided98 (Post 1583536)

put the robot on blocks so you can see what the motors are doing

^^^THIS

Put the bot on blocks. In software, give the following commands, and for each, record what each of the wheels is doing:

Pure Forward

Pure Strafe Right

Pure Rotate clockwise

... then post your results. From those results, it will be possible to identify what needs to be changed.

rlounds

05-04-2016 08:14 PM

Re: Mecanum Java Code

When I'm back in our robotics space tomorrow I'll get the information about the wheels, and we're currently running the robot on top of a tote bin. :)

rlounds

05-05-2016 06:16 PM

Re: Mecanum Java Code

So after trying some stuff out, here's the list of things you asked for Ether. We're also using a Logitech Extreme 3D Pro for our joystick.

Pure Forward:
Front Right = Spins forward
Front Left = Not working at all
Back Right = Spins forward
Back Left = Spins forward

Strafe Right:
Front Right = Spins forwards
Front Left = Not working at all
Back Right = Spins backwards
Back Left = Spins forwards

Rotating clockwise:
Front Right = Spins forwards
Front Left = Not working at all
Back Right = Spins forwards
Back Left = Spins backwards
***NOTE: FRONT LEFT TURNS FORWARDS WHEN TURNING COUNTER-CLOCKWISE

Ether

05-06-2016 01:50 PM

Re: Mecanum Java Code

Quote:

Originally Posted by Ether (Post 1583589)

Put the bot on blocks. In software, give the following commands...

Quote:

Originally Posted by rlounds (Post 1584187)

here's the list of things you asked for Ether. We're also using a Logitech Extreme 3D Pro for our joystick...

It sounds like you issued the commands by moving the joystick (hardware) instead of commanding them directly in software. Or am I misreading your post?

Quote:

Originally Posted by rlounds (Post 1584187)

Pure Forward:
Front Left = Not working at all

Strafe Right:
Front Left = Not working at all

Rotating clockwise:
Front Left = Not working at all

There is obviously something very wrong here. I suggest you try to get to the bottom of this first:

Try swapping Front Right and Front Left PWM cables and re-run the test. See if the problem follows the cables.

rlounds

05-12-2016 06:35 PM

Re: Mecanum Java Code

After all of the help I've received through this thread, we've manged to get everything working correctly. Thank you guys so much.

Ether

05-12-2016 06:41 PM

Re: Mecanum Java Code

Quote:

Originally Posted by rlounds (Post 1586261)

After all of the help I've received through this thread, we've manged to get everything working correctly. Thank you guys so much.

Please tell us why Front Left was not working at all.

rlounds

05-12-2016 06:43 PM

Re: Mecanum Java Code

The motor controller wasn't working correctly. We replaced it with another Victor 884 and it worked just fine. We also had a little incident of it another 884 sparking out and dying today so we'll also be changing it to use Talon SRs shortly.

Ether

05-12-2016 06:57 PM

Re: Mecanum Java Code

Quote:

Originally Posted by rlounds (Post 1586264)

The motor controller wasn't working correctly

How did you determine that?

Was this part of the process of identifying that problem?

Quote:

Originally Posted by (Post 1584533)

Try swapping Front Right and Front Left PWM cables and re-run the test. See if the problem follows the cables.

rlounds

05-12-2016 07:06 PM

Re: Mecanum Java Code

The problem solving process was swapping PWM cables as well as remembering that our old mecanum drive train had a major problems with shorting Victor 884s. Under further inspection, the controller was also having trouble initializing and didn't initialize most of the time.

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