// Listing 6.13. Mechanizm tłumaczący PUMT — kod obsługujący czujnik ultradźwiękowy MaxBotix EZ1 napisany w C++

1	const int PwPin = 7;  
2	
3	void setup()
4	{
5	    Serial.begin(9600);
6	}
7	
8	void loop()
9	{
10	    long Cm;
11	    Cm = ping();
12	    Serial.println(Cm);
13	    delay(100);
14	}
15	
16	long ping()
17	{
18	    long Time, Distance;
19	    pinMode(PwPin,INPUT);     
20	    Time = pulseIn(PwPin, HIGH);
21	    Distance = microToCentimeters(Time);
22	    return Distance;
23	}
24	
25	long microToCentimeters(long Micro)
26	{
27	    long Cm;
28	    Cm = Micro / 58;
29	    return Cm;
30	}


