先前看到很多報導有關緊急煞車的時後煞車燈會自動閃爍的系統 可有效提醒後方駕駛注意
#include <16F690.h>
#include <math.h>
#use delay (clock = 4000000)
#use i2c(master, sda=PIN_B4, scl=PIN_B6)
int adxl345_read(int add){
int retval;
i2c_start();
i2c_write(W_DATA);
i2c_write(add);
i2c_start();
i2c_write(R_DATA);
retval=i2c_read(0);
i2c_stop();
return retval;
}
long x,y,z;
int i=0;
int1 indicator=0;
//Function declearation
void initialize();
void readRegister(int max);
#define BLINKTIME 50
#define range 70
void main() {
unsigned lightState= 0;
signed int16 tempx,tempy,tempz;
unsigned int16 blinkcounter = BLINKTIME;
char enFlag =0;
float Heading;
volatile unsigned char BreakFlag;
int x=10;
int i=0;
signed int16 tmp[3];
output_high(PIN_B7);
adxl345_init();
BreakFlag=input(PIN_A2);
tmp[0]=0,tmp[1]=12;tmp[2]=248;
BASIC[0]=0,BASIC[1]=12;BASIC[2]=248;
while(1){
output_low(PIN_C2);
A_data[0]=adxl345_read(0x32); //Read X axis(LSB)
A_data[1]=adxl345_read(0x33); //Read X axis(MSB)
A_data[2]=adxl345_read(0x34); //Read Y axis(LSB)
A_data[3]=adxl345_read(0x35); //Read Y axis(MSB)
A_data[4]=adxl345_read(0x36); //Read Z axis(LSB)
A_data[5]=adxl345_read(0x37); //Read Z axis(MSB)
Xa=make16(A_data[1],A_data[0]);//Converting two 8 bit integer to one 16 bit integer
Ya=make16(A_data[3],A_data[2]);
Za=make16(A_data[5],A_data[4]);
Heading = atan2((signed int16)Ya,(signed int16)Xa)* 180 / pi + 180;
if(i>0)
if(Heading >0.6& BreakFlak)
{
enFlag = 1;
}
else
{
}
//output_high(PIN_C2);
for(i = 0;i<30;i++){
if(enFlag ==1 && blinkcounter >0)
{
if(lightState ==1)
{
lightState=0;
// output_low(PIN_C2);
output_low(PIN_B7);
}
else if(lightState ==0)
{
// output_high(PIN_C2);
output_high(PIN_B7);
lightState=1;
}
blinkcounter --;
if(blinkcounter <=1)
{
output_high(PIN_B7);
blinkcounter =BLINKTIME;
enFlag =0;
}
}
delay_ms(150);
}
}
/**************************************************************************/
留言列表
