智能车制作

标题: 超声波代码 distance为啥是实际距离的两倍？？ [打印本页]

作者: 老学童先生 时间: 2014-4-13 11:04
标题: 超声波代码 distance为啥是实际距离的两倍？？

#include "common.h"
#include "include.h"
#define  Trig PTA27  //超声波输入(触发)
#define  Echo PTD6  //超声波接收

#define  led1  PTB20_OUT//野火自带的led灯

void PORTD_IRQHandler(void);       //PORTD端口中断服务函数
void PIT0_IRQHandler(void);
uint8  m=0;
uint32  t=0;
uint8  f=0;
uint32 time=0;
uint32 time_rising=0;

void HC_SR04_Send(void)
{

gpio_set(Trig, 1);
DELAY_US(20);
gpio_set(Trig, 0);

//printf("\n Trig\n");
}

//float  distance=0;
uint32 distance=0;

void main()
{
// printf("\n*****csb测试*****\n");
gpio_init (Trig, GPO,0);
DELAY_US(2);

pit_init_us(PIT0, 100);                         //定时 1000 个bus时钟后中断  100us
set_vector_handler(PIT0_VECTORn,PIT0_IRQHandler); // 设置中断复位函数到中断向量表里
// enable_irq(PIT1_IRQn);                      //IRQ_RISING IRQ_FALLING  IRQ_EITHER
port_init(Echo, ALT1 | IRQ_EITHER | PULLUP );       //初始化 PTD7 管脚，复用功能为GPIO ，下降沿触发中断，上拉电阻
set_vector_handler(PORTD_VECTORn ,PORTD_IRQHandler); //设置PORTE的中断复位函数为 PORTE_IRQHandler
enable_irq (PORTD_IRQn);                               //使能PORTE中断
   //HC_SR04_Send();
   //DELAY_MS(50);
while(1)
{
      HC_SR04_Send();

      DELAY_MS(500);

}
}

void PORTD_IRQHandler(void)
{

uint8  n = 0; //引脚号
n = 6;
m++;
if(PORTD_ISFR & (1 << n))          //PTD7 触发中断
{
      PORTD_ISFR  = (1 << n);       //写1清中断标志位

      /*  以下为用户任务  */

   //  printf("\n按下按键\n");
   // key_handler();
      if(m==1)
      {
         t=0;
      // pit_init_ms(PIT1, 10);                         //定时 1000 个bus时钟后中断
      // set_vector_handler(PIT1_VECTORn,PIT1_IRQHandler); // 设置中断复位函数到中断向量表里
      enable_irq(PIT0_IRQn);                      // 使能LPTMR

      // pit_time_start  (PIT0);                //开始计时
      // printf("\ntime_start\n");

      }
      if((m==2)||(t>=348))
      {
         disable_irq(PIT0_IRQn);
         if(t>=348)
         t=348;
         //time_rising= pit_time_get(PIT1);       //获取 PITn计时时间
      //time_rising= pit_time_get_us (PIT1);       //获取 PITn计时时间
      // pit_time_close (PIT1);
         //time= 100*t;
      // printf("\n time为：%d us\n",time);
      //  f=t;
         // distance=(17*t)/2;
         distance=17*t;//(340*t*100us)/2=17*t 为啥是实际距离的两倍？？？？？
         printf("\n distance为：%d mm\n",distance); //打印延时时间
      //  t=0;
         m=0;
         //disable_irq(PIT1_IRQn);

      }
      /*  以上为用户任务  */
}

}

void PIT0_IRQHandler(void)
{

t++;
PIT_Flag_Clear(PIT0);    //清中断标志位
}

作者: warn00 时间: 2014-4-13 11:54
超声波发送再接收，一个来回

作者: BMN李 时间: 2014-4-13 15:21
往返就是两倍了嘛

作者: BMN李 时间: 2014-4-13 15:29
正好我也在写超声波，你这程序有问题吧。
port_init(Echo, ALT1 | IRQ_EITHER | PULLUP ); //初始化 PTD7 管脚，复用功能为GPIO ，下降沿触发中断，上拉电阻
下降沿触发中断？？

作者: 老学童先生 时间: 2014-4-13 21:37

BMN李发表于 2014-4-13 15:29
正好我也在写超声波，你这程序有问题吧。
port_init(Echo, ALT1 | IRQ_EITHER | PULLUP ); //初始 ...

跳变

作者: 老学童先生 时间: 2014-4-13 21:38

BMN李发表于 2014-4-13 15:21
往返就是两倍了嘛

可是我除以2了哈

作者: 老学童先生 时间: 2014-4-13 21:39

warn00 发表于 2014-4-13 11:54
超声波发送再接收，一个来回

可是我除以2了哈

作者: BMN李 时间: 2014-4-14 18:26
t没清零嘛

作者: 15282600864 时间: 2014-4-16 10:47
能不能把你的工程文件发我一份，我也认为你在距离计算了以后马上把t清零，我觉得你自己写了一部分底层驱动函数，用的是野火的库。823638601@qq.com

欢迎光临智能车制作 (http://dns.znczz.com/)