A VEX V5 robot program written in C++ developed for the Redmond High School Principles of Engineering course. Enables block stacking with both autonomous routines and manual control. Features integrated driving, turning, arm, and claw mechanisms—operable via controller or pre-programmed sequences.

• 🚗 Drive system

  • Four-motor tank drive (front/back, left/right).
  • Distance sensor support for automatic stopping.

• 🦾 Arm control

  • Dual motors for lifting.
  • Button mappings for raise/lower with hold braking.

• 🤲 Claw control

  • Dual motors for opening/closing.
  • Button mappings for grab/release with hold braking.

• 🤖 Autonomous routine

  • Lifts arm, turns, drives forward/backward, and grabs a block.
  • Uses distance sensor to approach target.
  • Places the block after navigating.

• 🎮 Manual control

  • Tank drive mapped to joysticks:
    • Axis2 → left side
    • Axis3 → right side
  • Arm mapped to R1 (up) and R2 (down)
  • Claw mapped to L1 (close) and L2 (open)

• driveForwardUntilDistance(targetDistance) Drives forward until the distance sensor detects an object closer than the target distance.

• drive(seconds, forwards) Drives forward or backward for a specified duration.

• turn(angle) Rotates robot by spinning left and right motors in opposite directions.

• remoteControll() Handles manual driving and arm/claw control via controller.

• automatic() Predefined sequence for picking up and stacking a block.

• main() Initializes system, runs the autonomous routine, then starts manual control loop.

• Drive Motors

  • Left Front: Port 1
  • Left Back: Port 2
  • Right Front: Port 11 (reversed)
  • Right Back: Port 12 (reversed)

• Arm Motors

  • Left Arm: Port 14
  • Right Arm: Port 15 (reversed)

• Claw Motors

  • Left Claw: Port 10
  • Right Claw: Port 9

• Sensors

  • Distance Sensor: Port 8

• Controller

  • Primary remote control

1. Deploy to VEX V5 Brain via VEXcode or compatible toolchain
2. On startup, the robot:
   • Runs the autonomous sequence once
   • Switches to manual control for driver operation

These are some images of the robot our group wrote this program for: