【超聲波測距避障+溫度補償+尋跡避障+風機吸塵清掃+故障報警+顯示LCD】
電路組成:
單片機最小系統電路、溫度檢測電路、按鍵電路、LCD1602顯示電路、蜂鳴器電路、繼電器驅動風機吸塵清掃電機、尋跡電路、驅動電路、超聲波測距避障電路
具體功能:
1、本設計基于STC89C52單片機為主控制器
2、LCD1602顯示溫度值以及三個超聲波傳感器采集的距離值
3、溫度的作用有2個,給予超聲波溫度補償,使得測量更加準確;電機溫度過高時,故障報警
4、當超聲波檢測到的距離小于30則認為該方向有障礙物
5、溫度超過50認為電機故障,此時蜂鳴器報警
6、按下啟動鍵,蜂鳴器滴一聲代表啟動,再拿一下,滴一聲代表關閉
7、當啟動時,2個清掃電機、1個吸塵電機、1個風機啟動進行工作,且進行尋跡避障
8、當關閉時,電機不工作,且小車不允許
9、尋跡避障邏輯
先去檢測有沒有障礙物
(1)若左側或者中間有障礙物則右轉,再左轉,再直行
(2)若是右側有障礙物則左轉,再右轉,再直行
當沒有檢測到障礙物時,去掃描尋跡傳感器傳遞的信號
(1)若沒有信號,則掃地機器人不動
(2)若檢測到左側引導線,則左小轉,若右側檢測到引導線,則右小轉
(3)若左側、中間都檢測到,則左大轉,若右側、中間都檢測到,則右大轉
(4)若只是中間檢測到,則直行
閱讀全文