Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- <pre>
- <font color="#5e6d03">#define</font> <font color="#000000">trigPin</font> <font color="#000000">13</font>
- <font color="#5e6d03">#define</font> <font color="#000000">echoPin</font> <font color="#000000">12</font>
- <font color="#5e6d03">#define</font> <font color="#000000">led</font> <font color="#000000">10</font>
- <font color="#5e6d03">#define</font> <font color="#000000">led2</font> <font color="#000000">9</font>
- <font color="#00979c">void</font> <font color="#5e6d03">setup</font><font color="#000000">(</font><font color="#000000">)</font> <font color="#000000">{</font>
- <b><font color="#d35400">Serial</font></b><font color="#434f54">.</font><font color="#d35400">begin</font> <font color="#000000">(</font><font color="#000000">57600</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#d35400">pinMode</font><font color="#000000">(</font><font color="#000000">trigPin</font><font color="#434f54">,</font> <font color="#00979c">OUTPUT</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#d35400">pinMode</font><font color="#000000">(</font><font color="#000000">echoPin</font><font color="#434f54">,</font> <font color="#00979c">INPUT</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#d35400">pinMode</font><font color="#000000">(</font><font color="#000000">led</font><font color="#434f54">,</font> <font color="#00979c">OUTPUT</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#d35400">pinMode</font><font color="#000000">(</font><font color="#000000">led2</font><font color="#434f54">,</font> <font color="#00979c">OUTPUT</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#000000">}</font>
- <font color="#00979c">void</font> <font color="#5e6d03">loop</font><font color="#000000">(</font><font color="#000000">)</font> <font color="#000000">{</font>
- <font color="#00979c">long</font> <font color="#000000">duration</font><font color="#434f54">,</font> <font color="#000000">distance</font><font color="#000000">;</font>
- <font color="#d35400">digitalWrite</font><font color="#000000">(</font><font color="#000000">trigPin</font><font color="#434f54">,</font> <font color="#00979c">LOW</font><font color="#000000">)</font><font color="#000000">;</font> <font color="#434f54">// Added this line</font>
- <font color="#d35400">delayMicroseconds</font><font color="#000000">(</font><font color="#000000">2</font><font color="#000000">)</font><font color="#000000">;</font> <font color="#434f54">// Added this line</font>
- <font color="#d35400">digitalWrite</font><font color="#000000">(</font><font color="#000000">trigPin</font><font color="#434f54">,</font> <font color="#00979c">HIGH</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#434f54">// delayMicroseconds(1000); - Removed this line</font>
- <font color="#d35400">delayMicroseconds</font><font color="#000000">(</font><font color="#000000">10</font><font color="#000000">)</font><font color="#000000">;</font> <font color="#434f54">// Added this line</font>
- <font color="#d35400">digitalWrite</font><font color="#000000">(</font><font color="#000000">trigPin</font><font color="#434f54">,</font> <font color="#00979c">LOW</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#000000">duration</font> <font color="#434f54">=</font> <font color="#d35400">pulseIn</font><font color="#000000">(</font><font color="#000000">echoPin</font><font color="#434f54">,</font> <font color="#00979c">HIGH</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#000000">distance</font> <font color="#434f54">=</font> <font color="#000000">(</font><font color="#000000">duration</font><font color="#434f54">/</font><font color="#000000">2</font><font color="#000000">)</font> <font color="#434f54">/</font> <font color="#000000">29.1</font><font color="#000000">;</font>
- <font color="#5e6d03">if</font> <font color="#000000">(</font><font color="#000000">distance</font> <font color="#434f54"><</font> <font color="#000000">4</font><font color="#000000">)</font> <font color="#000000">{</font> <font color="#434f54">// This is where the LED On/Off happens</font>
- <font color="#d35400">digitalWrite</font><font color="#000000">(</font><font color="#000000">led</font><font color="#434f54">,</font><font color="#00979c">LOW</font><font color="#000000">)</font><font color="#000000">;</font> <font color="#434f54">// When the Red condition is met, the Green LED should turn off</font>
- <font color="#d35400">digitalWrite</font><font color="#000000">(</font><font color="#000000">led2</font><font color="#434f54">,</font><font color="#00979c">HIGH</font><font color="#000000">)</font><font color="#000000">;</font> <font color="#434f54">// CHANGED THIS BIT 130516 FOR NC CONTACT ON BULB</font>
- <font color="#000000">}</font>
- <font color="#5e6d03">else</font> <font color="#000000">{</font>
- <font color="#d35400">digitalWrite</font><font color="#000000">(</font><font color="#000000">led</font><font color="#434f54">,</font><font color="#00979c">HIGH</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#d35400">digitalWrite</font><font color="#000000">(</font><font color="#000000">led2</font><font color="#434f54">,</font><font color="#00979c">LOW</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#000000">}</font>
- <font color="#5e6d03">if</font> <font color="#000000">(</font><font color="#000000">distance</font> <font color="#434f54">>=</font> <font color="#000000">200</font> <font color="#434f54">||</font> <font color="#000000">distance</font> <font color="#434f54"><=</font> <font color="#000000">0</font><font color="#000000">)</font><font color="#000000">{</font>
- <b><font color="#d35400">Serial</font></b><font color="#434f54">.</font><font color="#d35400">println</font><font color="#000000">(</font><font color="#005c5f">"Out of range - the distance is greater than 20cm"</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#000000">}</font>
- <font color="#5e6d03">else</font> <font color="#000000">{</font>
- <b><font color="#d35400">Serial</font></b><font color="#434f54">.</font><font color="#d35400">print</font><font color="#000000">(</font><font color="#000000">distance</font><font color="#000000">)</font><font color="#000000">;</font>
- <b><font color="#d35400">Serial</font></b><font color="#434f54">.</font><font color="#d35400">println</font><font color="#000000">(</font><font color="#005c5f">" cm"</font><font color="#000000">)</font><font color="#000000">;</font>
- <font color="#000000">}</font>
- <font color="#d35400">delay</font><font color="#000000">(</font><font color="#000000">200</font><font color="#000000">)</font><font color="#000000">;</font>
-
- <font color="#000000">}</font>
- </pre>
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement