import time
from RobokitRS import *
rs = RobokitRS.RobokitRS()
rs.port_open("/dev/cu.usbserial-0001")
# 적외선 센서 digital 12, 13 Port값 입력
rs.set_pin_mode(12,RobokitRS.Modes.INPUT)
rs.set_pin_mode(13,RobokitRS.Modes.INPUT)
# 초음파 센서 데이터 수집
rs.sonar_begin(2)
# 반환
#rs.sonar_read(2)
while(True):
lIR = rs.digital_read(13)
rIR = rs.digital_read(12)
SONAR = rs.sonar_read(2)
print(f"Left IR: {lIR}, Right IR: {rIR}, SONAR: {SONAR}")
rs.set_rgb_led_green(3)
rs.set_rgb_led_on(3)
if 1 <= SONAR and SONAR <= 10:
rs.set_mecanumwheels_drive_stop(1)
rs.set_rgb_led_red(3)
rs.set_rgb_led_on(3)
time.sleep(1)
else:
rs.set_rgb_led_green(3)
rs.set_rgb_led_on(3)
if rIR == 1:
if lIR == 1:
rs.set_mecanumwheels_drive_front(3, 1)
else:
rs.set_mecanumwheels_rotate_left(3, 1)
elif lIR == 1 :
rs.set_mecanumwheels_rotate_right(3, 1)
else:
rs.set_mecanumwheels_drive_stop(1)
rs.set_rgb_led_red(3)
rs.set_rgb_led_on(3)
time.sleep(1)
rs.set_rgb_led_off(3)
time.sleep(0.1)
# 동영상 첨부가 안되네요..
오... 코드를 작성해서 차를 움직이는 거군요. 초음파 센서도 있고 아주 흥미로운데요
다른사람이 하는 코딩은 멋있어 보이는데, 정작...ㅎㅎㅎ 멋저요!
열심히 코드 작성한 그대로 움직이면 기분이 너무 좋을 것 같아요!
아 동영상으로 구동되는걸 볼 수 있으면 더 좋았을텐데 아쉽네요 ㅠㅠ