/* PARAM FILE set for the Quadrupole cam movers */
/************************************************/

// Common definitions
#define CAM_DATA_DIR "C:\\magdata\\VibWire\\Quad\\Cam5data"
#define CAM_LOG_DIR "C:\\DatacCVI\\Cam_5_mover\\Log"
#define CAM_DATA_FILE "mech.dat"
#define PI 					3.141592653
#define PI4 				PI/4.
#define RAD_TO_ANGLE 		57.295779513
#define TRUE 				1
#define FALSE 				0
#define HP34970_CAM_MOVER_ADDR  5

// Cam movers geometry	   				// distances in meters
//front - 3; rear - 2
#define CAM_NUM 			5           // Number of cams  
#define TWO_CAM_ANGLE  		0.59341	// 34 degrees
#define THREE_CAM_ANGLE  	0.59341	// 34 degrees  
#define A 					.159385		// from cradle center to front vertex point horizontal (when the x manual adjustment micrometer is set to 8.5 mm)
#define B 					.26910		// from cradle center to front vertex point vertical
#define C2 					.27178		// from cradle center to 2 cam shafts vertical
#define C3 					.27178		// from cradle center to 3 cam shafts vertical
#define D 					.37661		// from cradle center to rear vertex point vertical
#define L 					.26688		// between front and rear cams horizontal
#define S1 					.024638		// between front vertex and angled cam center horizontal
#define S2 					.343408		// between front vertex and flat cam center horizontal
#define S3 					.184023		// between rear vertex and cam center horizontal
#define CAM_RADIUS   		.016000
#define CAM_OFFSET_1 		.000739 // 0.00075
#define CAM_OFFSET_2 		.000740 // 0.00075
#define CAM_OFFSET_3 		.000738 // 0.00075
#define CAM_OFFSET_4 		.000737 // 0.00075
#define CAM_OFFSET_5 		.000728 // 0.00075
#define GEAR_RATIO 			100

//Cam initial angles
#define CAM_1_ANGLE 	 	THREE_CAM_ANGLE// * RAD_TO_ANGLE 
#define CAM_2_ANGLE 		-THREE_CAM_ANGLE// * RAD_TO_ANGLE 
#define CAM_3_ANGLE 	 	0
#define CAM_4_ANGLE 		-TWO_CAM_ANGLE// * RAD_TO_ANGLE 
#define CAM_5_ANGLE 	 	TWO_CAM_ANGLE // * RAD_TO_ANGLE 

// Motion parameters
#define DO_ITERACTIONS    	FALSE
#define LED_ON 				TRUE 
#define STEP_SIZE  			1
#define NUM_STEPS  			1
#define TIME_INT   			0
#define MOT_ACC   			ACC							// motor acceleration
#define MOT_VEL				VEL  					    // motor velocity

// motor direction of rotation
#define MOTOR_1_DIRECTION   	1
#define MOTOR_2_DIRECTION  		-1
#define MOTOR_3_DIRECTION   	1
#define MOTOR_4_DIRECTION  		-1
#define MOTOR_5_DIRECTION   	1

// Pot parameters
#define POT_SWITCH_POSITION 	7 				// Pot Switch channel in HP3903 switch box 

//#define POT_RANGE 				6.0214	//nominal
#define POT_RANGE_1				6.050865
#define POT_RANGE_2				6.019723
#define POT_RANGE_3				6.030828 
#define POT_RANGE_4				6.038171 
#define POT_RANGE_5				6.025944 

#define MAX_POT_VOLTAGE 		4.5 
#define ANGLE_OFFSET_1 			0 //-0.000122	// in radians (-0.007 in degrees)
#define ANGLE_OFFSET_2 			0 //0.001658 	//(0.095)
#define ANGLE_OFFSET_3 			0 //-0.001222	//(-0.07) 
#define ANGLE_OFFSET_4 			0 //-0.000733 	//(-0.042)
#define ANGLE_OFFSET_5 			0 //0.000925	//(0.053) 
#define ANGLE_DIR_1   			-1
#define ANGLE_DIR_2    			1
#define ANGLE_DIR_3   			-1
#define ANGLE_DIR_4   			1
#define ANGLE_DIR_5   			-1

// Gage parameters
#define GAGE_NUMBER  			0
#define GAGE_Y_FRONT 			4
#define GAGE_Y_REAR  			3 
#define GAGE_X_FRONT 			2 
#define GAGE_X_REAR  			1 

// Communication parameters
#define CAM_HP_GPIB_ADDR				1 								// GPIB board number for HP34970A 
#define CAM_RS232_PORT  			CM6K6_COM_PORT  				// RS232 COM port number

// Undulator initial coordinates (to be set negative to measured values)
#define CAM_START_X       			 0.0    		// X in meters
#define CAM_START_Y      			 0.0     		// Y in meters
#define CAM_START_ROLL   			 0.0   			// Roll in degrees
#define CAM_START_PITCH   			 0.0 			// Pitch in degrees
#define CAM_START_YAW    			 0.0 			// Yaw in degrees

// Cam test parameters
#define TEST_CAM_NUM 				1
#define TEST_GAGE_NUMBER  			1 
#define GAGE                     	1