写一段可以控制超声波模块来测量距离的单片机C语言代码

#include <reg51.h> #include <stdio.h>

#define TRIG P1_0 #define ECHO P1_1

void delay_us(unsigned int us) { while(us--) { nop(); } }

void main() { unsigned int distance; TMOD = 0x01; while(1) { TRIG = 0; delay_us(2); TRIG = 1; delay_us(10); TRIG = 0; while(!ECHO); TH0 = 0; TL0 = 0; while(ECHO); distance = (TH0 << 8) + TL0; distance = distance / 58; printf("The distance is %d cm\n",distance); delay_ms(1000); }