Preseason Lesson3

Disable motor when limit switch is tripped

The goal is to move the motor using the joystick, but stop moving if a sensor it tripped (even if the joystick says to move). This simulates the driver moving an elevator up & down, but the code automatically stopping the motor when the elevator reaches it limits.

 

It is expected that you completed Lesson 2 and have the code available.

The switches are consider digital inputs. Link to the DigitalInput documentation: DigitalInput

In Robot.h we will need an object/variable that is the switch. We will need two switches, one for each limit of travel. The class/object type is: frc::DigitialInput We will name the objects: m_switchA and m_switchB In Robot.h, in the 'private:' section add the following line:

   frc::DigitalInput m_switchA{0};
   frc::DigitalInput m_switchB{1};

The '{0}' indicates the constructor will be called and '0' will be passed in for the channel parameter. NOTE: The switches on the test board are labelled with which channel they are on.

 

The frc::DigitalInput class contains the method 'Get()', which is what we will use to see if the switch is tripped. The method returns 'true' if the switch is tripped.

 

In Robot.cpp, you will modify the code in the Robot::OperatorControl() method. You will add more logic to the 'if's that are checking for the joystick position from lesson 2 (see the red bold text in the sample code below).

You will want to first test if the trigger is pressed. If it is pressed, then you will look at the position to see if the position to determine how to turn the motor. Here is the pseudo code (i.e. not actual code, replace the English words with actual code):

   if (joystick trigger is pressed) {
       if ((joystick position is greater than 0.33) and (switch A is not tripped)) {
           spin motor forward 1/4 speed
       }
       else if ((joystick position is less than -0.33) and (switch B is no tripped)) {
           spin motor reverse 1/4 speed
       }
       else {
           stop motor
       }
   }
   else {
       stop motor
   }

 

 

After you have modified Robot.h and Robot.cpp, build the project.