#include "main.h"
#include "EZ-Template/api.hpp"
#include "api.h"

#pragma once

#ifndef CONFIG_H
#define CONFIG_H

/**
 * 
 */
inline pros::Controller master;
inline pros::Controller slave;

/**
 * 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({'A',true});

/**
 * Declare sensors here
 */
inline pros::Rotation liftRotation({15});
inline pros::Rotation armRotation({16});
inline pros::Rotation wristRotatio({17});

inline pros::Optical colorSensorOne({18});
inline pros::Optical colorSensorTwo({19});

#endif