1983Defines2012.h

#ifndef __1983DEFINES_H
#define __1983DEFINES_H

#define PRACTICE_BOT 1
#define PRACTICE_OI 0
#define REGULAR_OI 0
#define JOYSTICK_CONTROL 1

//PewPew Start
#define DEADBAND 0.04
//PewPew End

//Camera
#define TRACKING_CAMERA 1

//Kinect Start
#define KINECT 0
#define KINECT_HIP_DIFF 0.15
#define KINECT_DEADBAND 0.05
//Kinect End

//Autonomous Start
#define LOOP_STABILITY 1//5 //This define represents the amount of loops a readout must be consistently true to for the autonomous stuff to read it
//Autonomous Stop

//DriveBase Start
#define DRIVE_PID 1
//Air Compressor
#if PRACTICE_BOT
#define COMPRESSOR_SWITCH_PORT 5
#else
#define COMPRESSOR_SWITCH_PORT 4
#endif
#define DIGITAL_MODULE 1 
#define SOLENOID_MODULE 1
#define COMPRESSOR_PORT 1
#define SHIFTER_CHANNEL 1
#define SHIFTER_LOW_CHANNEL 2
#define POKER_CHANNEL 5
#define POKER_CHANNEL_B 6

//Drive Victors
#define GOGO 0
#if GOGO
#define VIC_PORT_LEFT_1 8
#else
#define VIC_PORT_LEFT_1 1
#endif
#define VIC_PORT_LEFT_2 2
#define VIC_PORT_RIGHT_1 3
#define VIC_PORT_RIGHT_2 4

//Encoders
#define ENCODER_SLOT 1
#define LEFT_ENCODER_PORT_A 13
#define LEFT_ENCODER_PORT_B 14
#define RIGHT_ENCODER_PORT_A 11
#define RIGHT_ENCODER_PORT_B 12

#define ENCODER_MAX .000546
#define ENCODER_TO_ANGLE 360.0/ENCODER_MAX
#define ENCODER_SAMPLE_RATE 0.002

//Conversion stuff
#define DRIVE_REDUCTION_HIGH (7.67/3.125) //3.125 is sketchyfix
#define DRIVE_REDUCTION_LOW (30.67/3.125) 
#define TICKS_PER_REVOLUTION 250.0
#define WHEEL_CIRCUMFERENCE 1.571 //in Feet
#define REVOLUTIONS_PER_FOOT (1.0/WHEEL_CIRCUMFERENCE) //At the wheel rev/feet
#define FEET_PER_TICK_HIGH (1.0/(TICKS_PER_REVOLUTION * DRIVE_REDUCTION_HIGH * REVOLUTIONS_PER_FOOT))
#define FEET_PER_TICK_LOW (1.0/(TICKS_PER_REVOLUTION * DRIVE_REDUCTION_LOW * REVOLUTIONS_PER_FOOT))

//PIDs
#define DRIVE_P 1.05
#define DRIVE_I 0.05//0.1
#define DRIVE_D 0.05

#define DRIVE_P_LOW 0.85
#define DRIVE_I_LOW 0.05
#define DRIVE_D_LOW 0.05

#define TURN_P 1.00
#define TURN_I 0.00
#define TURN_D 0.00

#define TURN_P_LOW 2.3
#define TURN_I_LOW 0.0
#define TURN_D_LOW 0.0

#define LIGHT_SENSOR_CHANNEL_FRONT 2
#define LIGHT_SENSOR_CHANNEL_BACK 1
#define LIGHT_SENSOR_CHANNEL_BRIDGE 3
#define LIGHT_CHANNEL 2 //Last value: 1
//Gyro Channel	
#define GYRO_CHANNEL 1

//Max speeds for the wheels in low and high gears
#define MAXSPEEDHIGH 14.7
#define MAXSPEEDLOW  3.7

#define LINE_STOP_SPEED .75 //The speed at which the robot runs to stop at the key
//DriveBase End

//Shooter Start
#define SHOOTER_MAX_SPEED 3840.0
#define SHOOTER_CHANGE_LIMIT 1.0
#define SHOOTER_CHANGE_LIMIT_IS_ONE 0
#define GO_POINT 2100.0/SHOOTER_MAX_SPEED //this is about 1600 rpm
#define GO_SPEED 0.55
#define SPINUP_SPEED 1.0
#define SPINUP_LOW_POINT 1000.0/SHOOTER_MAX_SPEED
#define SPINDOWN_SPEED 0.15
#define SCALE_LOW_POINT 200.0/SHOOTER_MAX_SPEED
#define BEGIN_SPEED 0.2

#define SHOOTER 1
#define SHOOTER_PID 1
#define SHOOTER_BANGBANG 0

//Conversion stuff
#define SHOOTER_UNITS_PER_TICK ((double)0.234375) //(60.0/256.0) Last bit is janky hack 
#define SHOOTER_VIC_CHANNEL1 8				//Channel for shooter wheel
#define SHOOTER_VIC_CHANNEL2 9
#define SHOOTER_HOOD_CHANNEL 0

#define SHOOTER_WHEEL_ENCODER_A 9		//Channels for the shooter wheel's encoder
#define SHOOTER_WHEEL_ENCODER_B 10

//Accuracy tolerance.  How close	 the speed/position has to get to be accurate
#define SHOOTER_VELOCITY_TOLERANCE_LOW	10.0	//Tolerance of the velocity
#define SHOOTER_VELOCITY_TOLERANCE_HIGH 20.0
//PID Tolerance. How close does the speed have to be to the setpoint for us to engage pid mode?
//#define SHOOTER_PID_RANGE 400.0/SHOOTER_MAX_SPEED
//SHooter PIDs
#define KU 5.85
#define TU 50.0
#define SHOOTER_P 3.800//(KU * 0.6)//1.20
#define SHOOTER_I 0.068//(SHOOTER_P * 2.0/TU)//0.05
#define SHOOTER_D 0.75//(SHOOTER_P * TU/8.0)//0.05
#define SHOOTER_P_HIGH 3.800//1.20
#define SHOOTER_I_HIGH 0.068//.065//0.620//0.087
#define SHOOTER_D_HIGH 0.75//0.05
#define SHOOTER_READY_STABLITY 10

//Preset shot speeds
#define SHOT_KEYTOP_SPEED 3300.0 

#define SHOT_FREETHROW_SPEED 2525.0//2560.0
#define SHOT_OTHER_SPEED 0.0

#define BALL_SPEED_TO_RPM(speed) {return speed;}   //TODO Conversion
#define AVERAGE_LENGTH 10.0

//Shooter End

//Tipper Start
#define TIPPER_UP_CHANNEL 4
#define TIPPER_DOWN_CHANNEL 3
//Tipper End

//Collector Start
#define COLLECTOR_VIC_TIPPER 10
#define COLLECTOR_VIC_PICKUP 5
#define COLLECTOR_VIC_LOW 6
#define COLLECTOR_VIC_TOP 7
//Number of sensed ball storage spots
#define COLLECTOR_SLOT_COUNT 3
//Belt Vic Speed
#define COLLECTOR_BELT_SPEED 0.4
#define COLLECTOR_FEED_SPEED 1.0
//Collector Vic Speed
#define COLLECTOR_PICKUP_SPEED 0.8
#define COLLECTOR_TIPPER_SPEED 1.0
//Timeout for blind running collectors
#define COLLECTOR_TIMEOUT 100
#define SHOOTER_TIMEOUT 10//last working value:30

//Collector IR Sensors
#if PRACTICE_BOT
#define COLLECTOR_IR_LOW_CHANNEL 7
#define COLLECTOR_IR_MID_CHANNEL 6
#define COLLECTOR_IR_TOP_CHANNEL 8
#else
#define COLLECTOR_IR_LOW_CHANNEL 5
#define COLLECTOR_IR_MID_CHANNEL 6
#define COLLECTOR_IR_TOP_CHANNEL 7
#endif
//Collector End

//Autonomous Stuff
#define AUTONOMOUS_DELAY 5000.0 //8 seconds
#define AUTONOMOUS_SHOT C1983Shooter::kFreethrow
//End AUtonomous

//Controls Begin
#define SHIFT_BUTTON lStick->GetRawButton(1)
#define COLLECT_BUTTON (rStick->GetRawButton(1))// || !myEIO->GetDigital(12))
#if PRACTICE_OI
#define ARM_BUTTON (!myEIO->GetDigital(16))
#define SHOOT_BUTTON  (!myEIO->GetDigital(14))
#define POKE_SWITCH (rStick->GetRawButton(10))
#else
#define ARM_BUTTON (/*myEIO->GetDigital(16) || */joyArmButton->getState())
#define SHOOT_BUTTON (/*myEIO->GetDigital(14) || */lStick->GetRawButton(7))
#define POKE_SWITCH (/*!myEIO->GetDigital(2) || */lStick->GetRawButton(8))
#endif
#define FORWARD_SWITCH (/*!myEIO->GetDigital(4) || */lStick->GetRawButton(11))
#define REVERSE_SWITCH (/*!myEIO->GetDigital(6) || */lStick->GetRawButton(10))
#define TIPPER_SWITCH !(/*myEIO->GetDigital(10) || */joyTipButton->getState())
#define SHORT_SHOT_SWITCH 0//(myEIO->GetDigital(8))
#define RPM_MANUAL_SLIDER
#if !PRACTICE_OI
#define KEY_ALIGN_BUTTON (/*!myEIO->GetDigital(15) || */rStick->GetRawButton(9))
#else
#define KEY_ALIGN_BUTTON (lStick->GetRawButton(5))
#endif
#define AUTO_TARGET_BUTTON (lStick->GetRawButton(2))//(!myEIO->GetDigital(11))
#define FULL_AUTO_SWTICH 0//(!myEIO->GetDigital(13)) //spelled wrong
#define LIGHT_BUTTON (lStick->GetRawButton(3))
#define SHOOTER_MANUAL_MODE false
#define KINECT_OVERRIDE (0)

//Autonomous Controls
#define AUTONOMOUS_DELAY_SWITCH 0//(!myEIO->GetDigital(13))
#define AUTONOMOUS_FULL_AUTO_SWITCH 0//(!myEIO->GetDigital(13))

//Slider stuff
#define PID_SLIDER (0.292333957)//(myEIO->GetAnalogIn(2))

//LEDs
#define FRONT_LINE_LED(s) ()//(myEIO->SetDigitalOutput(7,!s))
#define BACK_LINE_LED(s) ()//(myEIO->SetDigitalOutput(9,!s))
#define AUTO_RANGE_LED(s) ()//(myEIO->SetDigitalOutput(3,!s))
#define AUTO_YAW_LED(s) ()//(myEIO->SetDigitalOutput(5,!s))
#define BRIDGE_LED(s) ()//(myEIO->SetDigitalOutput(7,!s))
#define RPM_LOCK_LED(s) ()//(myEIO->SetDigitalOutput(1,!s))
#define LED_FLASH_RATE 1000
#endif