Chief Delphi

Chief Delphi (http://www.chiefdelphi.com/forums/index.php)
-   C/C++ (http://www.chiefdelphi.com/forums/forumdisplay.php?f=183)
-   -   Robot Code Not Working (http://www.chiefdelphi.com/forums/showthread.php?t=112822)

Arrowhead 05-02-2013 17:33
Robot Code Not Working
 
So we recently got our new CRio in, and after getting it set up, we started testing our code. We have just got the code uploaded to the CRio, but when we run it, none of our Victors do anything, and our code doesnt seem to be making any changes to anything. We built our code without errors. Here is our code, and here is the messages we get in the driver station diagnostics menu

Code:
#include "WPILib.h"               


class RobotDemo : public SimpleRobot
{

       
       
Victor laquanda;                                //front left motor:V1
Victor anabel;                                        //back left motor:V2
Victor rotciv;                                        //front right motor:V3
Victor shanaynay;                                //back right motor:V4

RobotDrive rDrive;                                //declare robot drive
               
Victor shooterVictor;                                //declare victor for shooter
Victor shooterVictor2;

Servo loaderArm;                                //declare servo for loader arm
       
Joystick driverStick;                        //declares all 3 joysticks
Joystick driverStick2;
Joystick shooterStick;

Victor climbingArm1;                        //declare victors for climbing arms
Victor climbingArm2;

Solenoid SC1;                                //declares solenoids for climbing arm
Solenoid SC2;

DigitalInput Disk1;                        //declares limit switches for hopper
DigitalInput Disk2;
DigitalInput Disk3;
DigitalInput Disk4;



public:


        RobotDemo(void):
               
        laquanda(1),                        //assign drive motors PWM ports
        anabel(2),                               
        rotciv(3),                               
        shanaynay(4),

        rDrive(laquanda, anabel, rotciv, shanaynay),                        //assigns robot drive talons theiw PWM ports

        shooterVictor(6),                //assigns victor its PWM port
        shooterVictor2(7),

        loaderArm(5),                        //assign servo its PWM port

        driverStick(1),                        //assign joysticks their USB ports
        driverStick2(2),
        shooterStick(3),

        climbingArm1(8),                //assigns climbing victors PWM ports
        climbingArm2(9),

        SC1(1),                                //assigns climbing pneumatics digital output ports
        SC2(2),

        Disk1(3),                        //assigns limit switches digital input ports
        Disk2(4),
        Disk3(5),
        Disk4(6)

        {
       
        Watchdog().SetEnabled(false);       

        rDrive.SetExpiration(0.1);
        rDrive.SetSafetyEnabled(true);                        //sets motor saftey on for all motors

        shooterVictor.SetExpiration(0.1);
        shooterVictor.SetSafetyEnabled(true);
       
        shooterVictor2.SetExpiration(0.1);
        shooterVictor2.SetSafetyEnabled(true);

        loaderArm.SetExpiration(0.1);
        loaderArm.SetSafetyEnabled(true);

        climbingArm1.SetExpiration(0.1);
        climbingArm1.SetSafetyEnabled(false);

        climbingArm2.SetExpiration(0.1);
        climbingArm2.SetSafetyEnabled(false);

        }

       
        void Autonomous(void)
        {
               
        DriverStationLCD *ds = DriverStationLCD::GetInstance();       
               
        double AutoTime = 0;                        //used to measure time during autonomous

       
        rDrive.SetSafetyEnabled(false);                                //turn of motor saftey timers during autonomous for convience

        shooterVictor.SetSafetyEnabled(false);
        shooterVictor2.SetSafetyEnabled(false);

        loaderArm.SetSafetyEnabled(false);

        ds->PrintfLine(DriverStationLCD::kUser_Line1, "Program Started Successfully!");
        ds->PrintfLine(DriverStationLCD::kUser_Line2, "Robot Is in Autonomous");
       
        ds->UpdateLCD();
       
        while(IsAutonomous()){

               
                /**
                        //start at center autonomous
                        if(AutoTime>=0.0 && AutoTime<0.5){
                                shooterVictor.Set(1.0);
                                shooterVictor2.Set(1.0);
                                rDrive.MecanumDrive_Cartesian( 0.0 , 0.0 , -0.5 );
                                }
                               
                        if(AutoTime>=0.5 && AutoTime<1.0){
                                loaderArm.SetAngle(180); 
                                }

                        if(AutoTime>=1.0 && AutoTime<1.5){
                                loaderArm.SetAngle(0);
                                }

                        if(AutoTime>=1.5 && AutoTime<2.0){
                                loaderArm.SetAngle(180);
                                }

                        if(AutoTime>=2.0 && AutoTime<2.5){
                                loaderArm.SetAngle(0);
                                }

                        if(AutoTime>=2.5 && AutoTime<3.0){
                                loaderArm.SetAngle(180);
                                }

                        if(AutoTime>=3.0 && AutoTime<3.5){
                                loaderArm.SetAngle(0);
                                shooterVictor.Set(0.0);
                                shooterVictor2.Set(0.0);
                                }

                        if(AutoTime>=3.5 && AutoTime<4.0){
                                rDrive.MecanumDrive_Cartesian( 0.0, 0.0 , 0.5 );
                                }

                        if(AutoTime>=4.0 && AutoTime<7.0){
                                rDrive.MecanumDrive_Cartesian( 1.0 , 0.0 , 0.0 );
                                }

                        if(AutoTime>=7.0 && AutoTime<9.0){
                                rDrive.MecanumDrive_Cartesian( 0.0 , 1.0 , 0.0 );
                                }
                               
                        if(AutoTime>=9.0 && AutoTime<10.0){
                                rDrive.MecanumDrive_Cartesian( 0.0 , 0.0 , 0.5 );
                                }

                        if(AutoTime>=10.0 && AutoTime<10.5){
                                rDrive.MecanumDrive_Cartesian( 0.7 , 0.0 , 0.0 );
                                }
                */
               
               
                //start at left or right autonomous
                if(AutoTime>=0.0 && AutoTime<0.5){
                        shooterVictor.Set(1.0);
                        shooterVictor2.Set(1.0);
                        loaderArm.SetAngle(180); 
                        }

                if(AutoTime>=0.5 && AutoTime<1.0){
                        loaderArm.SetAngle(0);
                        }

                if(AutoTime>=1.0 && AutoTime<1.5){
                        loaderArm.SetAngle(180);
                        }

                if(AutoTime>=1.5 && AutoTime<2.0){
                        loaderArm.SetAngle(0);
                        }

                if(AutoTime>=2.0 && AutoTime<2.5){
                        loaderArm.SetAngle(180);
                        }

                if(AutoTime>=2.5 && AutoTime<3.0){
                        loaderArm.SetAngle(0);
                        shooterVictor.Set(0.0);
                        shooterVictor2.Set(0.0);
                        }

                if(AutoTime>=3.0 && AutoTime<6.0){
                        rDrive.MecanumDrive_Cartesian(1.0, 0.0 , 0.0 );
                        }

                if(AutoTime>=6.0 && AutoTime<7.0){
                        rDrive.MecanumDrive_Cartesian( 0.0 , 0.0 , -0.5 );        //left autonomous = -0.5 turn                right autonomous = 0.5 turn
                        }

                if(AutoTime>=7.0 && AutoTime<9.0){
                        rDrive.MecanumDrive_Cartesian( 0.7 , 0.0 , 0.0 );
                        }

                AutoTime=AutoTime+0.02;
                Wait(0.02);
                }
        }
               

        void operatorControl(){

        rDrive.SetSafetyEnabled(true);                                //turn motor saftey timers back on

                shooterVictor.SetSafetyEnabled(true);
        shooterVictor2.SetSafetyEnabled(true);

        loaderArm.SetSafetyEnabled(true);
       
        DriverStationLCD *ds = DriverStationLCD::GetInstance();
       
        ds->PrintfLine(DriverStationLCD::kUser_Line6, "Pinkie Pie Is Best Pony");

                while (IsOperatorControl()){
                       
                ds->PrintfLine(DriverStationLCD::kUser_Line2, "Robot Is In TeleOp");

                rDrive.MecanumDrive_Cartesian(driverStick.GetX(), driverStick.GetY(), driverStick2.GetX());                        //gets input for robot drive
                                                                                                                                                                                                                        //from joysticks 1/2
                ShooterControl();                //runs shooter control function

                LoaderControl();                //runs servo control function

                //Climbing();                        //runs pryamid climbing function

                //DiskCount();                        //runs diskcount function       
               
                ds->UpdateLCD();

                Wait(0.02);                        //waits 0.02 seconds
                        }
                }


        void ShooterControl(){                        //shooter control function
                DriverStationLCD *ds = DriverStationLCD::GetInstance();
                if(shooterStick.GetRawButton(1)){
                        shooterVictor.Set(1.0);                        //if trigger is pressed, turn on shooter
                        shooterVictor2.Set(1.0);
                        ds->PrintfLine(DriverStationLCD::kUser_Line3, "Shooter Is On");
                        }
                else{
                        shooterVictor.Set(0.0);                        //if trigger isnt pressed, turn off shooter
                        shooterVictor2.Set(0.0);
                        ds->PrintfLine(DriverStationLCD::kUser_Line3, "Shooter Is Off");
                        }
                }


        void LoaderControl(){                        //servo control function
                DriverStationLCD *ds = DriverStationLCD::GetInstance();
                if(shooterStick.GetRawButton(3)){
                        loaderArm.SetAngle(180);                        //if middle button is pressed, extend servo
                        ds->PrintfLine(DriverStationLCD::kUser_Line4, "Loader Servo Is Extended");
                        }
                else{
                        loaderArm.SetAngle(0);                                //if middle button isnt pressed, retract servo
                        ds->PrintfLine(DriverStationLCD::kUser_Line4, "Loader Servo Is Retracted");
                        }
                }


        void Climbing(){                                                //pyramid climbing function, happens automatically
                DriverStationLCD *ds = DriverStationLCD::GetInstance();
                if(shooterStick.GetRawButton(6) && driverStick.GetRawButton(6)){                //if button 6 pressed on both sticks, starts climb
               
                ds->PrintfLine(DriverStationLCD::kUser_Line2, "Robot Is Climbing");
               
                ds->UpdateLCD();
                       
                rDrive.SetSafetyEnabled(false);                                //turn of motor saftey timers during climbing for convience

                shooterVictor.SetSafetyEnabled(false);
                shooterVictor2.SetSafetyEnabled(false);

                loaderArm.SetSafetyEnabled(false);

                bool climbingRunning=true;                                                        //checks if robot continues to climb
                double CTime = 0;
                double VCTime=0;
       
                while(climbingRunning=true){
       
                        if(CTime>=0.0 && CTime<1.0){                       
                                climbingArm1.Set(0.4);                        //raise climbing arms
                                climbingArm2.Set(0.4);
                                VCTime=VCTime+0.05;
                                }

                        if(CTime>=1.0 && CTime<1.5){
                                climbingArm1.Set(0.0);                        //extend climbing arms
                                climbingArm2.Set(0.0);
                                SC1.Set(true);
                                SC2.Set(true);
                                }

                       
                        if(CTime>=1.5 && CTime<2.0){
                                rDrive.MecanumDrive_Cartesian( 0.2 , 0.0 , 0.0 );        //move towards bar
                                }

                        if(CTime>=2.0 && CTime<2.5){
                                SC1.Set(false);                //retract climbing arms
                                SC2.Set(false);
                                }

                       
                        if(shooterStick.GetRawButton(7)){               
                                climbingRunning=false;                        //if button 7 pressed, stops climbing               
                                climbingArm1.Set(-0.4);                       
                                climbingArm2.Set(-0.4);
                                Wait(VCTime);
                                SC1.Set(false);               
                                SC2.Set(false);

                                rDrive.SetSafetyEnabled(true);                                //turn motor saftey timers back on
       
                                shooterVictor.SetSafetyEnabled(true);
                                shooterVictor2.SetSafetyEnabled(true);
               
                                loaderArm.SetSafetyEnabled(true);
                                }
                       

                        Wait (0.05);

                        CTime=CTime+0.05;
                        }
                        }
                }

       
        void DiskCount(){                        //function that counts disk in the hopper and displays it
                DriverStationLCD *ds = DriverStationLCD::GetInstance();
                int disknum = 0;                //variable that counts disks in hopper

                if(Disk1.Get()){
                        disknum=disknum+1;        //disk has activated a limit switch, add 1 to # of disks
                        }
                if(Disk2.Get()){
                        disknum=disknum+1;
                        }
                if(Disk3.Get()){
                        disknum=disknum+1;
                        }
                if(Disk4.Get()){
                        disknum=disknum+1;
                        }

                ds->PrintfLine(DriverStationLCD::kUser_Line5, "Disk's in Hopper: %d", disknum);        //print out the number of disks in hopper
       
               
                }

        };

START_ROBOT_CLASS(RobotDemo);                //starts the class running
Warning <Code> 44002 occurred at Ping Results: link-GOOD, DS radio(.4)-bad, robot radio(.1)-bad, cRIO(.2)-GOOD, FMS-bad Driver Station
<time>2/6/2013 5:28:08 AM<unique#>104
FRC: Driver Station ping status has changed.
ERROR: A timeout has been exceeded: PWM 5 on module 1... Output not updated often enough. ...in Check() in C:/WindRiver/workspace/WPILib/MotorSafetyHelper.cpp at line 117


ERROR: A timeout has been exceeded: PWM 7 on module 1... Output not updated often enough. ...in Check() in C:/WindRiver/workspace/WPILib/MotorSafetyHelper.cpp at line 117


ERROR: A timeout has been exceeded: PWM 6 on module 1... Output not updated often enough. ...in Check() in C:/WindRiver/workspace/WPILib/MotorSafetyHelper.cpp at line 117


ERROR: A timeout has been exceeded: RobotDrive... Output not updated often enough. ...in Check() in C:/WindRiver/workspace/WPILib/MotorSafetyHelper.cpp at line 117
ERROR: A timeout has been exceeded: PWM 5 on module 1... Output not updated often enough. ...in Check() in C:/WindRiver/workspace/WPILib/MotorSafetyHelper.cpp at line 117
[/code]

jwakeman 05-02-2013 21:07
Re: Robot Code Not Working
 
The code looks pretty good. I like your Victor names. Did you write all of it without testing any of it? Or has this just become a problem after getting your new cRio? It's hard to tell from all that code where exactly the problem might be. You might want to try using NetConsole and add some print statements to your code to see where it is getting locked up...the "output not updated" errors suggest your code is locked up somewhere. If you are using the WPILib PIDController class there are some defects that cause task deadlocks.

Hjax 05-02-2013 21:26
Re: Robot Code Not Working
 
You forgot to disable motor safety.
Motor safety kills the robot if you don't pass an update to the motor often enough (if i remember correctly)

Just put this line:
Code:
myRobot.SetSafetyEnabled(false);
before this line:
Code:
while (isOperatorControl()){
This will disable the motor safety (not a bad thing in this case to keep your motors spinning and your code working)

Arrowhead 06-02-2013 08:20
Re: Robot Code Not Working
 
Quote:
Originally Posted by jwakeman (Post 1228428)
The code looks pretty good. I like your Victor names. Did you write all of it without testing any of it? Or has this just become a problem after getting your new cRio? It's hard to tell from all that code where exactly the problem might be. You might want to try using NetConsole and add some print statements to your code to see where it is getting locked up...the "output not updated" errors suggest your code is locked up somewhere. If you are using the WPILib PIDController class there are some defects that cause task deadlocks.
This is the first time we are testing the code, as we havent had a working CRio before now.
What is this net console you talk about?
Also, what is the PIDController class?
It looks like i have some reading to do

Arrowhead 06-02-2013 08:22
Re: Robot Code Not Working
 
Quote:
Originally Posted by Hjax (Post 1228433)
You forgot to disable motor safety.
Motor safety kills the robot if you don't pass an update to the motor often enough (if i remember correctly)

Just put this line:
Code:
myRobot.SetSafetyEnabled(false);
before this line:
Code:
while (isOperatorControl()){
This will disable the motor safety (not a bad thing in this case to keep your motors spinning and your code working)
we have tried that, the code still does nothing, and the only difference is that we don't get timeout errors
Also, we shouldn't be getting timeout errors, as they should be getting updated often enough.

Alan Anderson 06-02-2013 09:42
Re: Robot Code Not Working
 
All those diagnostic messages to the DS "LCD" window might be clogging the network communication and causing enough lag to trip the motor safeties. Take them out temporarily just to see if that's the cause of your problem.

jwakeman 06-02-2013 12:45
Re: Robot Code Not Working
 
Quote:
Originally Posted by Arrowhead (Post 1228645)
This is the first time we are testing the code, as we havent had a working CRio before now.
What is this net console you talk about?
Also, what is the PIDController class?
It looks like i have some reading to do
If you haven't tested any of the code before I would recommend starting small and then adding in one piece at a time verifying that things work as expected as you go. Just comment out everything in your while(IsAutonomous()) loop and while(IsOperatorControl()) loop and then uncomment one line at a time testing each time. Another way of saying this is you should do 'unit testing' to verify each function is working as intended, then do 'integration testing' to verify all the functions/units work together correctly.

You may not need to use NetConsole since you are already sending print statements to the LCD but is here is a link to the documentation http://wpilib.screenstepslive.com/s/...ing-netconsole.

PIDController is one of the classes available in the WPILib that is used for doing closed-loop PID control. Here's the link for that http://wpilib.screenstepslive.com/s/...rs-pid-control

Arrowhead 06-02-2013 15:28
Re: Robot Code Not Working
 
So we tried running the simple robot template code on the robot, and it didnt run, so right now we are looking at the ribbon cable running between the CRio and the digital sidecar as the culprit.
We should be bale to get another one within the next 2 days or so.

Arrowhead 06-02-2013 16:26
Re: Robot Code Not Working
 
So we switched out the CRio module for an older one and it now runs the simple robot code perfectly.
We then tried running our code. We disabled motor safety timers and still get errors about motors not being updated enough. When we start running the code in tele op after deploying it nothing happens. However, when we run autonomous the motors move, but dont stop, and dont seem to be doing anything specified in our code. If we then run the robot in tele op after running it in autonomous, the same motors stay on and dont reply to any user input.

kingroosevelt 08-02-2013 16:11
Re: Robot Code Not Working
 
Arrowhead,

Team 4243 has been having the exact same problem. Out of the box Simple Robot and Default Robot templates work out of the box on an 8-slot cRIO but fails with timeout errors on a 4-slot cRIO.

This is our second year and the same problem annihilated our rookie performance last year. At that time we managed to disable the timeouts but our code effectively executed at 3 Hz instead of 50 Hz resulting in pretty embarrassing performance.

Fortunately we had an 8-slot cRIO Team 342 had lent us to get some programming knowledge before last year's build season started. And, thanks to this thread, I changed out our 4-slot cRIO for the 8-slot cRIO, and the Simple Robot Template compiled and executed flawlessly!!! I repeated the experience with the Default Robot template. What a relief!!

Given all the related threads on MotorSafetyHelper timeout messages, I think it is clear WPILib is not fully compatible with the 4-slot cRIO. Not last year and not this year.

Arrowhead 08-02-2013 16:45
Re: Robot Code Not Working
 
Oh, we fixed the problem we were having, the problem was the "O" in OperatorControl wasnt capitalized :/


All times are GMT -5. The time now is 12:55.

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