Carter
6d79b61626
Made the arm check the height of the lift and move to a different state based on the height of the lift and made the wrist move a specific amount only when the arm passes a threshold. Added new functions that allow me to quickly change the controller and buttons being used to control different mechanisms. Added a new function specificly for autonomouse which allows me to select the desired positon of every mechanism. Changed the name of almost every function and enumeration to better match the rest of the program.
38 lines
716 B
C++
38 lines
716 B
C++
#include "main.h"
|
|
#include "EZ-Template/api.hpp"
|
|
#include "api.h"
|
|
|
|
#pragma once
|
|
|
|
#ifndef CONFIG_H
|
|
#define CONFIG_H
|
|
|
|
/**
|
|
*
|
|
*/
|
|
inline pros::Controller master(pros::E_CONTROLLER_MASTER);
|
|
inline pros::Controller slave(pros::E_CONTROLLER_PARTNER);
|
|
|
|
/**
|
|
* Declare mechinism motors
|
|
*/
|
|
inline pros::MotorGroup lift({10, 11});
|
|
inline pros::MotorGroup wrist({13, 14});
|
|
inline pros::Motor arm({12});
|
|
|
|
/**
|
|
* Declare pistons here
|
|
*/
|
|
inline ez::Piston claw({'G',true});
|
|
|
|
/**
|
|
* Declare sensors here
|
|
*/
|
|
inline pros::Rotation liftRotation({15});
|
|
inline pros::Rotation armRotation({16});
|
|
inline pros::Rotation wristRotation({17});
|
|
|
|
inline pros::Optical colorSensorOne({18});
|
|
inline pros::Optical colorSensorTwo({19});
|
|
|
|
#endif |