#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 wristRotatio({17});

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

#endif