You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
351 lines
8.1 KiB
351 lines
8.1 KiB
/*
|
|
* level - electronic level using the ADXL202
|
|
*
|
|
* $Id: standalone_test.c 713 2006-03-15 00:01:20Z azhyd $
|
|
* $Source$
|
|
*
|
|
* This program consists of an interrupt routine that measures the pulse
|
|
* width from the ADXL202 and a main routine that updates the dot matrix
|
|
* display on the DISPLAY board.
|
|
*
|
|
* Timer1 and the two Capture/Compare registers are used to measure the
|
|
* pulse width.
|
|
*
|
|
* Use PICCLITE to compile this program for the PIC16F877.
|
|
*
|
|
* tqStatus: Sept 25, 2003
|
|
* Working. The code is pretty brute force and the resolution isn't
|
|
* what I expected. Need to review calculations for angle vs. accel
|
|
* (gravity). I determined the zero offsets empirically and hard coded
|
|
* them. For coding simplicity I am discarding any measurements where
|
|
* the counter overflows during the measurement.
|
|
*
|
|
* Improvements should include: a method to zero the offsets at
|
|
* runtime and increased gain (which probably means going to 16 bit
|
|
* values). Also consider filtering the measured values to gain stability.
|
|
* Add code to handle counter overflow.
|
|
*/
|
|
|
|
#include <pic.h>
|
|
|
|
/*
|
|
* bit macros suggested by the PICCLITE manual
|
|
*/
|
|
#define BITSET(var, bitno) ((var) |= 1 << (bitno))
|
|
#define BITCLR(var, bitno) ((var) &= ~(1 << (bitno)))
|
|
|
|
|
|
/*
|
|
* pulse with variables
|
|
*
|
|
* These are set up the measurePW() ISR and read by the main loop
|
|
*/
|
|
unsigned char PeriodStartX;
|
|
unsigned char PeriodEndX;
|
|
unsigned char PulseEndX;
|
|
unsigned char PulseEndTempX;
|
|
unsigned char PWSyncX;
|
|
|
|
unsigned char PeriodStartY;
|
|
unsigned char PeriodEndY;
|
|
unsigned char PulseEndY;
|
|
unsigned char PulseEndTempY;
|
|
unsigned char PWSyncY;
|
|
|
|
/*
|
|
* interrupt service routine to measure pulse width
|
|
*
|
|
* This routine uses the capture facility of the 16F877 to measure the
|
|
* period and the pulse width of a signal. This routine has two states
|
|
* the first looks for the rising edge of the signal which indicates the
|
|
* end of one period and the beginning of the next. The second state
|
|
* looks for the falling edge of the signal to determine the pulse
|
|
* width.
|
|
*
|
|
* Only the high 8 bits of the captured time are record. At 20MHz this
|
|
* yields a time resolution of approximately 51us.
|
|
*
|
|
* RC0 and RC1 indicate ISR over-run (in other words the main loop did
|
|
* not handle the measured values quickly enough).
|
|
*/
|
|
void interrupt
|
|
measurePW(void)
|
|
{
|
|
/* determined which capture register requires service */
|
|
if (CCP1IF == 1)
|
|
{
|
|
/* CCP1 */
|
|
if ((CCP1CON & 0b00000111) == 0b00000101)
|
|
{
|
|
/* rising edge-
|
|
* record last rise time (period_end -> period_start)
|
|
* record last falling time (pulse_end_temp -> pulse_end)
|
|
* record this rise time (capture -> period_end)
|
|
* set synchronization flag
|
|
* change mode to look for falling edge
|
|
*/
|
|
PeriodStartX = PeriodEndX;
|
|
PulseEndX = PulseEndTempX;
|
|
PeriodEndX = CCPR1H;
|
|
PWSyncX++;
|
|
CCP1CON = 0b00000100;
|
|
|
|
/* Indicated an ISR over-run if the sync flag was
|
|
* not cleared by the main loop
|
|
*/
|
|
if (PWSyncX > 1)
|
|
{
|
|
RC0 = 0;
|
|
}
|
|
}
|
|
else /* assume falling edge */
|
|
{
|
|
/* falling-
|
|
* save this falling time for later
|
|
* change mode to look for rising edge
|
|
*/
|
|
PulseEndTempX = CCPR1H;
|
|
CCP1CON = 0b00000101;
|
|
}
|
|
/*
|
|
* clear interrupt flags and return
|
|
*/
|
|
CCP1IF = 0;
|
|
}
|
|
else
|
|
{
|
|
/* CCP2 */
|
|
if ((CCP2CON & 0b00000111) == 0b00000101)
|
|
{
|
|
/* rising edge-
|
|
* record last rise time (period_end -> period_start)
|
|
* record last falling time (pulse_end_temp -> pulse_end)
|
|
* record this rise time (capture -> period_end)
|
|
* set synchronization flag
|
|
* change mode to look for falling edge
|
|
*/
|
|
PeriodStartY = PeriodEndY;
|
|
PulseEndY = PulseEndTempY;
|
|
PeriodEndY = CCPR2H;
|
|
PWSyncY++;
|
|
CCP2CON = 0b00000100;
|
|
|
|
/* Indicated an ISR over-run if the sync flag was
|
|
* not cleared by the main loop
|
|
*/
|
|
if (PWSyncY > 1)
|
|
{
|
|
RC3 = 0;
|
|
}
|
|
}
|
|
else /* assume falling edge */
|
|
{
|
|
/* falling-
|
|
* save this falling time for later
|
|
* change mode to look for rising edge
|
|
*/
|
|
PulseEndTempY = CCPR2H;
|
|
CCP2CON = 0b00000101;
|
|
}
|
|
/*
|
|
* clear interrupt flags and return
|
|
*/
|
|
CCP2IF = 0;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* measure tilt and update dot matrix display
|
|
*
|
|
* This program uses the times recorded by the measurePW() ISR to
|
|
* calculate pulse width. The pulse width is then translated into a tilt
|
|
* measurement and finally displayed on the dot matrix display.
|
|
*/
|
|
void
|
|
main(void)
|
|
{
|
|
unsigned char periodX = 0;
|
|
unsigned char pulseX = 0;
|
|
unsigned char periodY = 0;
|
|
unsigned char pulseY = 0;
|
|
int tiltX;
|
|
int tiltY;
|
|
|
|
/*
|
|
* Setup I/O ports
|
|
* RC0 and RC3 outputs, the rest are inputs.
|
|
* RA5 output (power to ADXL202)
|
|
* Set port C outputs high to turn off the LEDs
|
|
*/
|
|
TRISC = 0b11110110;
|
|
RA5 = 1;
|
|
PORTC = 0xff;
|
|
|
|
/*
|
|
* Setup the I/O ports that control the dot matrix display
|
|
*/
|
|
TRISA = 0b11000000;
|
|
TRISB = 0b11100000;
|
|
TRISD = 0b10000000;
|
|
ADCON1 = 0x06; /* disable ADC so that port A is digital I/O */
|
|
PORTD = 0; /* turn off all rows */
|
|
PORTB = 0xff; /* turn off all columns */
|
|
PORTA = 0xff; /* turn off all columns */
|
|
|
|
/* configure timer1
|
|
* 1:1 prescale
|
|
* Internal clock (Fosc/4)
|
|
* Enabled
|
|
*/
|
|
T1CON = 0b00000001;
|
|
|
|
/*
|
|
* configure capture registers
|
|
* capture on rising edge
|
|
*/
|
|
CCP1CON = 0b00000101;
|
|
CCP2CON = 0b00000101;
|
|
|
|
/*
|
|
* clear sync flag
|
|
*/
|
|
PWSyncX = 0;
|
|
PWSyncY = 0;
|
|
|
|
/*
|
|
* enable interrupts
|
|
*/
|
|
PEIE = 1;
|
|
CCP1IE = 1;
|
|
CCP2IE = 1;
|
|
ei();
|
|
|
|
/*
|
|
* main loop
|
|
*/
|
|
for (;;)
|
|
{
|
|
/*
|
|
* kick watchdog
|
|
*/
|
|
CLRWDT();
|
|
|
|
if (PWSyncX > 0)
|
|
{
|
|
/*
|
|
* Test for easy calculations
|
|
* i.e., no counter roll over during the measurment
|
|
*/
|
|
if (PeriodEndX > PeriodStartX)
|
|
{
|
|
if (PulseEndX > PeriodStartX)
|
|
{
|
|
/*
|
|
* no roll over, so proceed
|
|
*/
|
|
periodX = PeriodEndX - PeriodStartX;
|
|
pulseX = PulseEndX - PeriodStartX;
|
|
|
|
periodX = (periodX / 2) + 9; /* offset = 9 */
|
|
tiltX = (periodX) - pulseX;
|
|
|
|
/*
|
|
* turn off all rows and then figure out which row to turn
|
|
* on based on the tilt
|
|
*/
|
|
PORTD = 0;
|
|
if (tiltX < -5)
|
|
{
|
|
RD6 = 1;
|
|
}
|
|
else if (tiltX < -4)
|
|
{
|
|
RD5 = 1;
|
|
}
|
|
else if (tiltX < -2)
|
|
{
|
|
RD4 = 1;
|
|
}
|
|
else if (tiltX > 5)
|
|
{
|
|
RD0 = 1;
|
|
}
|
|
else if (tiltX > 4)
|
|
{
|
|
RD1 = 1;
|
|
}
|
|
else if (tiltX > 2)
|
|
{
|
|
RD2 = 1;
|
|
}
|
|
else
|
|
{
|
|
RD3 = 1;
|
|
}
|
|
}
|
|
}
|
|
PWSyncX = 0;
|
|
}
|
|
|
|
if (PWSyncY > 0)
|
|
{
|
|
/*
|
|
* Test for easy calculations
|
|
* i.e., no counter roll over during the measurment
|
|
*/
|
|
if (PeriodEndY > PeriodStartY)
|
|
{
|
|
if (PulseEndY > PeriodStartY)
|
|
{
|
|
/*
|
|
* no roll over, so proceed
|
|
*/
|
|
periodY = PeriodEndY - PeriodStartY;
|
|
pulseY = PulseEndY - PeriodStartY;
|
|
|
|
periodY = (periodY / 2) - 1; /* offset = -1 */
|
|
tiltY = (periodY) - pulseY;
|
|
|
|
/*
|
|
* turn off all columns then figure out which column
|
|
* to turn on based on the tilt
|
|
*/
|
|
PORTA = PORTA | 0b00111111;
|
|
PORTB = PORTB | 0b00011111;
|
|
if (tiltY < -5)
|
|
{
|
|
RB1 = 0;
|
|
}
|
|
else if (tiltY < -4)
|
|
{
|
|
RB0 = 0;
|
|
}
|
|
else if (tiltY < -2)
|
|
{
|
|
RA4 = 0;
|
|
}
|
|
else if (tiltY > 5)
|
|
{
|
|
RA0 = 0;
|
|
}
|
|
else if (tiltY > 4)
|
|
{
|
|
RA1 = 0;
|
|
}
|
|
else if (tiltY > 2)
|
|
{
|
|
RA2 = 0;
|
|
}
|
|
else
|
|
{
|
|
RA3 = 0;
|
|
}
|
|
}
|
|
}
|
|
PWSyncY = 0;
|
|
}
|
|
}
|
|
}
|
|
|