Add sub systems and commands for the arm and end effector (grabber) of the robot
arm and grabber should be separate subsystems
Motors
Main arm joint: falcon
Secondary arm joint: neo
grabber: neo
Other sensors
Also, we will probably need 1 or 2 limit switches for the arm joints in order to reset encoders, which we will use to determine how far the arm has traveled.
For sensing the grabber, we may use another limit switch.
Add sub systems and commands for the arm and end effector (grabber) of the robot arm and grabber should be separate subsystems
Motors
Main arm joint: falcon Secondary arm joint: neo grabber: neo
Other sensors
Also, we will probably need 1 or 2 limit switches for the arm joints in order to reset encoders, which we will use to determine how far the arm has traveled.
For sensing the grabber, we may use another limit switch.