stm32 030 超声波使用代码

ID:548229 · 发表于 2019-5-28 16:49

                                          u32 m = 0;
                                             int i = 0;
                                       int J = 0;
                                             float lengthTemp = 0;
                                             float sum = 0;
                                             while(i!=5)
                                             {
                                                      GPIO_SetBits(GPIOB,GPIO_Pin_6);
                                                      delay_us(20);
                                                      GPIO_ResetBits(GPIOB,GPIO_Pin_6);
                                                      while(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_7)==0)
                                                      {
                                                                                             J++;    //??????????
                                                                                             if(J == 2000) break;
                                                      }
                                                      if(J < 2000)
                                                      {
                                                            TIM16->CNT=0;
                                                            msHcCount_B=0;
                                                            TIM_Cmd(TIM16,ENABLE);
                                                            i = i + 1;
                                                            while(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_7)==1);
                                                            TIM_Cmd(TIM16,DISABLE);

                                                            m = msHcCount_B*50000;//??MS
                                                            m+=TIM16->CNT;

                                                               TIM16->CNT = 0;  //TIM2
                                                               delay_ms(50);

                                                               lengthTemp = ((float)m/58.0);//cm

                                                            sum = lengthTemp + sum ;
                                                      }
                                                      else
                                                      {
                                                                              i = i + 1;
                                                                     //       sum=0;
                                                                              printf("distance_B=ERROR \r\n");
                                                      }
                                                               J=0;
                                             }
                                          lengthTemp=sum/5;

                                             printf("distance_B=%03.f \r\n",lengthTemp);
                                                            if(lengthTemp<50.00)
                                                            {
                                                                     sendData[75] = 0x31;
                                                            }
                                                            else
                                                            {
                                                                     sendData[75] = 0x30;
                                                            }
                                    }

ID:1 · 发表于 2019-5-30 18:16

本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)

帐号		自动登录	找回密码
密码			立即注册