Colony

#ifndef _RANGEFINDER_H_

#define _RANGEFINDER_H_

#define RANGE_IN0 PIN_C0

//old range_in0

//#define RANGE_IN0 PIN_AN5

/*  These do not exist yet.

#define RANGE_IN1 PIN_??

#define RANGE_IN2 PIN_

#define RANGE_IN3 PIN_

#define RANGE_IN4 PIN_

#define RANGE_IN5 PIN_

#define RANGE_IN6 PIN_

#define RANGE_IN7 PIN_

*/

#define RANGE_CTRL PIN_C1

//old range_crtl

//#define RANGE_CTRL PIN_A7

#define THRESHOLD1 114

#define THRESHOLD2 110

#define THRESHOLD3 101

#define THRESHOLD4 85

#define OFFSET1 65

#define OFFSET2 63

#define OFFSET3 60

#define GAIN1 1525

#define GAIN2 1520

#define GAIN3 1525

#define CONTINUITY_FIX 39

#define MAX_DIST 61

#define MIN_DIST 8

#ifdef FFPP

// IR range finders are indexed 0-4.

// IR1 is front left, IR2 is front center, IR3 is front right, IR4 is rear right, IR5 is rear left.

// active low

#define IR_ENABLE PC7

/* Nasty IR approximation table

  I'm using this for the heck of it.  We can do whatever.

  Note the minimum value is .4V (20), and the maximum is 2.6V (133).

  Gives distance in mm.

  excel formula(valid for inputs 20-133):  ROUND(2353.6*(E2^(-1.1146))*10,0)

  This is only valid for the GP2D12, with objects directly ahead and more than

  10cm from the detector.  See the datasheet for more information.

*/

#define MIN_IR_ADC8 20

#define MAX_IR_ADC8 133

void enable_IR(void);

void disable_IR(void);

int read_IR_val(int);

int convert_IR_distance(int);

int get_IR_distance(int);

#endif

int read_distance(int range_id);

int linearize_distance(int reading);

int log_distance(int distance);

#endif