PI-18Baguhan

Parking sensor gamit ang Raspberry Pi Pico (HC-SR04 + 3 LED + buzzer)

Dalhin sa mesa mo ang reverse parking sensor ng kotse! Gumagamit ang Raspberry Pi Pico ng HC-SR04 ultrasonic sensor para sukatin ang distansya sa harang nang mga 16 na beses bawat segundo. Habang lumalapit ito, salitang sumisindi ang berde, dilaw at pulang LED at bumibilis ang beep ng buzzer; sa ilalim ng 10 cm, nagiging tuloy-tuloy ang tono at kumikislap ang pulang LED. Ultrasonic na pagsukat ng distansya, PWM na tunog at non-blocking timing sa iisang project.

0.0(0)
1 tapos na
Parking sensor gamit ang Raspberry Pi Pico (HC-SR04 + 3 LED + buzzer)
Desktop na bersyon ng parking sensor sa kotse. Naglalabas ang HC-SR04 ng tunog na masyadong mataas para sa tainga mo at pinakikinggan ang echo para sukatin kung gaano kalayo ang harang; kapag may lumapit sa loob ng isang metro, sisindi ang berdeng LED at dahan-dahang magbe-beep ang buzzer. Habang lumalapit ito, sumasali ang dilaw at pulang LED at bumibilis at tumataas ang beep, at sa ilalim ng 10 sentimetro, hindi tumitigil ang tono habang kumikislap ang pulang ilaw.

Video

Circuit diagram

Parking sensor gamit ang Raspberry Pi Pico (HC-SR04 + 3 LED + buzzer) - Circuit diagram

Source code

MicroPython
1# ─────────────────────────────────────────
2#   BlueGrays · bluegrays.com
3#   Raspberry Pi Pico Parking Sensor (HC-SR04 + 3 LEDs + Buzzer)
4# ─────────────────────────────────────────
5# Car parking sensor. The HC-SR04 measures the distance to an obstacle; as
6# it gets closer the green, yellow and red LEDs light up in turn and the
7# beeps speed up. Very close, the tone becomes continuous and the red LED
8# flashes.
9#
10# Pins:
11#   GP27 -> HC-SR04 TRIG
12#   GP26 -> HC-SR04 ECHO (1k + 2k divider on real hardware)
13#   VBUS -> HC-SR04 VCC (5V), GND.6 -> HC-SR04 GND
14#   GP4  -> 220 ohm -> Red LED (cathode to GND)
15#   GP8  -> 220 ohm -> Yellow LED (cathode to GND)
16#   GP12 -> 220 ohm -> Green LED (cathode to GND)
17#   GP17 -> Buzzer (+), other leg to GND
18
19from machine import Pin, PWM, time_pulse_us
20import time
21
22# ============ SETTINGS ============
23GREEN_CM = 100         # Green on, beeping starts
24YELLOW_CM = 50         # Yellow joins in
25RED_CM = 25            # Red joins in
26STOP_CM = 10           # Continuous tone + flashing red
27
28BEEP_MS = 60           # Length of one beep
29SLOW_GAP_MS = 700      # Gap between beeps at GREEN_CM
30FAST_GAP_MS = 50       # Gap between beeps near STOP_CM
31VOLUME = 32768         # PWM duty, 32768 = 50%
32FLASH_MS = 120         # Red flash period in STOP zone
33
34MEASURE_MS = 60        # Measure interval, min 60 ms
35PRINT_MS = 250         # Serial print interval
36ECHO_TIMEOUT_US = 12000  # beyond ~2 m = no obstacle
37SOUND_CM_PER_US = 0.0343  # Speed of sound (20 C)
38LOOP_MS = 5            # Main loop step
39
40# Zones from near to far: (name, upper limit cm, (green, yellow, red), tone Hz)
41ZONES = (
42    ("STOP", STOP_CM, (1, 1, 1), 1900),
43    ("RED", RED_CM, (1, 1, 1), 1900),
44    ("YELLOW", YELLOW_CM, (1, 1, 0), 1500),
45    ("GREEN", GREEN_CM, (1, 0, 0), 1200),
46)
47CLEAR = len(ZONES)     # No obstacle zone
48STOP = 0               # Index of the STOP zone
49
50# ============ HARDWARE ============
51trig = Pin(27, Pin.OUT, value=0)
52echo = Pin(26, Pin.IN)
53led_green = Pin(12, Pin.OUT, value=0)
54led_yellow = Pin(8, Pin.OUT, value=0)
55led_red = Pin(4, Pin.OUT, value=0)
56buzzer = PWM(Pin(17))
57buzzer.duty_u16(0)
58
59
60# ============ MEASUREMENT ============
61def measure_cm():
62    # Send a 10 us TRIG pulse, time how long ECHO stays HIGH
63    trig.value(0)
64    time.sleep_us(2)
65    trig.value(1)
66    time.sleep_us(10)
67    trig.value(0)
68    pulse = time_pulse_us(echo, 1, ECHO_TIMEOUT_US)
69    if pulse < 0:
70        return None    # No echo or too far
71    # Sound travels there and back: half
72    return pulse * SOUND_CM_PER_US / 2
73
74
75def median3(values):
76    # Median of the last 3 readings: one bad reading does not flicker the LEDs
77    a, b, c = values
78    return max(min(a, b), min(max(a, b), c))
79
80
81def zone_of(dist):
82    if dist is None:
83        return CLEAR
84    for i, zone in enumerate(ZONES):
85        if dist <= zone[1]:
86            return i
87    return CLEAR
88
89
90def beep_gap_ms(dist):
91    # Between STOP_CM and GREEN_CM the beep gap grows linearly from FAST to SLOW
92    ratio = (dist - STOP_CM) / (GREEN_CM - STOP_CM)
93    ratio = min(1.0, max(0.0, ratio))
94    return int(FAST_GAP_MS + ratio * (SLOW_GAP_MS - FAST_GAP_MS))
95
96
97# ============ SOUND ============
98tone_on = False
99tone_hz = 0
100
101
102def tone(hz):
103    # Leave PWM alone if the tone is already on
104    global tone_on, tone_hz
105    if tone_on and tone_hz == hz:
106        return
107    buzzer.freq(hz)
108    buzzer.duty_u16(VOLUME)
109    tone_on = True
110    tone_hz = hz
111
112
113def silence():
114    global tone_on
115    if tone_on:
116        buzzer.duty_u16(0)
117        tone_on = False
118
119
120def set_leds(green, yellow, red):
121    led_green.value(green)
122    led_yellow.value(yellow)
123    led_red.value(red)
124
125
126def self_test():
127    # Short power-on test of LEDs and buzzer: green -> yellow -> red
128    for leds, hz in (((1, 0, 0), 1200), ((1, 1, 0), 1500), ((1, 1, 1), 1900)):
129        set_leds(*leds)
130        tone(hz)
131        time.sleep_ms(90)
132        silence()
133        time.sleep_ms(160)
134    set_leds(0, 0, 0)
135
136
137# ============ MAIN LOOP ============
138print("== BlueGrays · bluegrays.com ==")
139print("Parking Sensor")
140print("LEDs: green <= %d cm, yellow <= %d cm, red <= %d cm, continuous tone <= %d cm"
141      % (GREEN_CM, YELLOW_CM, RED_CM, STOP_CM))
142print("Beep: starts at %d cm, higher pitch at %d cm and %d cm, continuous at %d cm"
143      % (GREEN_CM, YELLOW_CM, RED_CM, STOP_CM))
144self_test()
145
146FAR = 999.0                       # Placeholder for no obstacle
147history = [FAR, FAR, FAR]         # Last 3 readings
148distance = None                   # Filtered distance (cm)
149zone = CLEAR
150last_zone = -1
151now = time.ticks_ms()
152next_measure = now
153next_print = now
154last_beep = time.ticks_add(now, -10000)   # First beep plays at once
155beep_end = now
156
157while True:
158    now = time.ticks_ms()
159
160    # 1) Measurement: every MEASURE_MS, with a median filter
161    if time.ticks_diff(now, next_measure) >= 0:
162        next_measure = time.ticks_add(now, MEASURE_MS)
163        reading = measure_cm()
164        history = history[1:] + [reading if reading is not None else FAR]
165        filtered = median3(history)
166        distance = None if filtered >= FAR else filtered
167        zone = zone_of(distance)
168        if zone != last_zone:
169            name = "CLEAR" if zone == CLEAR else ZONES[zone][0]
170            print("Zone ->", name)
171            last_zone = zone
172
173    # 2) LEDs: bar graph, red flashes in the STOP zone
174    if zone == CLEAR:
175        set_leds(0, 0, 0)
176    elif zone == STOP:
177        flash_on = (now // FLASH_MS) % 2 == 0
178        set_leds(1, 1, 1 if flash_on else 0)
179    else:
180        set_leds(*ZONES[zone][2])
181
182    # 3) Sound: non-blocking beep timer
183    if zone == CLEAR:
184        silence()
185    elif zone == STOP:
186        tone(ZONES[STOP][3])          # Very close: continuous tone
187    else:
188        if tone_on and time.ticks_diff(now, beep_end) >= 0:
189            silence()
190        # The gap is recalculated every pass: the next beep speeds up as soon as you get closer
191        period = BEEP_MS + beep_gap_ms(distance)
192        if not tone_on and time.ticks_diff(now, last_beep) >= period:
193            tone(ZONES[zone][3])
194            last_beep = now
195            beep_end = time.ticks_add(now, BEEP_MS)
196
197    # 4) Serial monitor: distance in cm
198    if time.ticks_diff(now, next_print) >= 0:
199        next_print = time.ticks_add(now, PRINT_MS)
200        if distance is None:
201            print("Distance: --- (no obstacle)")
202        else:
203            print("Distance: %5.1f cm" % distance)
204
205    time.sleep_ms(LOOP_MS)
206

FAQ

Bakit kailangan ng voltage divider ang ECHO sa totoong circuit?

Gumagana sa 5V ang HC-SR04 at 5V ang ECHO output nito, pero hanggang 3.3V lang ang tinatanggap ng mga pin ng Pico. Ikonekta ang ECHO sa GP26 sa pamamagitan ng 1 kΩ at ang GP26 sa GND sa pamamagitan ng 2 kΩ, kaya mga 3.3V ang nakikita ng pin. Hindi kailangan ng divider sa Wokwi.

Paano ko papalitan ang mga distansya ng babala?

I-edit ang mga constant na `GREEN_CM`, `YELLOW_CM`, `RED_CM` at `STOP_CM` sa itaas ng code. Panatilihin ang pagkakasunod ng threshold na `STOP_CM < RED_CM < YELLOW_CM < GREEN_CM`; halimbawa, gamitin ang `STOP_CM = 30`, `RED_CM = 50`, `YELLOW_CM = 100` at `GREEN_CM = 150`. Awtomatikong sumusunod ang mga LED at beep sa mga bagong threshold.

Bakit unti-unting bumibilis ang beep sa halip na bawat zone?

Linear na ini-scale ng `beep_gap_ms()` ang pagitan ayon sa distansya: 700 ms sa 100 cm, 50 ms sa 10 cm. Kinukuwenta ulit ito sa bawat ikot ng main loop, kaya mas maaga ang kasunod na beep sa sandaling lumapit ang harang. Ang mga LED at pitch lang ang binabago ng mga zone.

Kailangan ko bang mag-install ng anumang library?

Hindi. Bahagi ng built-in na `machine` module ang function na `time_pulse_us()` na ginagamit sa pagsukat. I-flash ang MicroPython sa Pico at i-save dito ang code bilang `main.py` sa Thonny; kusang magsisimula ang sensor sa LED test at tatlong beep.