會開發這個程式是因為正好在重新設計 ROSA，文創造設計工作室的張宇文老師正在設計一個超音波感測讓垃圾桶蓋開閉的程式，因此就順手寫一個相同功能的程式。
主程式為 ROSA_Door.ino，Arduino pin 12, 11 分別連接超音波感測器 trig, echo，pin 9 接 servo ，並使用 USB 來幫忙除錯，所以 pin 1, 0 分別為 TX, RX，baud 115200 bps，程式碼如下：
// (C) 2019-2020, Bridan Wang, CC BY-NC-SA 3.0 TW // This is a demo program applied Robot Operating System for Arduino (ROSA) // http://4rdp.blogspot.tw/search/label/ROSA%20(Arduino) //軟件許可協議 // //研發養成所 Bridan Wang 提供此軟體供學校教育或個人單獨使用 //對外分享展示本軟體時，請說明來源來自研發養成所 //你可以架構在本軟體基礎上，設計新功能或修改 //本軟體屬於 Bridan 和或其它原始碼供應商，並受適用的法律版權保護 //此軟體按“原樣”提供，可能含有錯誤，不作任何明示，暗示或法律的保證 //本軟體僅限 Arduino 部分微控制器產品，適用於特定用途 // Bridan 在任何情況、環境以及特殊使用不負任何原因損害賠償責任 // //這是 ROSA 韌體版本的一部分。 // //建議使用 Arduino-1.8.8 以後版本編譯，因為有發現舊版本有錯誤情形 /*********************************************************** // System Condition DEFINE ************************************************************/ #define PRODUCT "ROSA,Door " #define VERSION "v2020.5.12" //#define TIME_2ms // ROSA_TIME_2ms() //#define TIME_10ms // ROSA_TIME_10ms() #define TIME_50ms // ROSA_TIME_50ms() //#define TIME_100ms // ROSA_TIME_100ms() //#define TIME_250ms // ROSA_TIME_250ms() #define TIME_500ms // ROSA_TIME_500ms() //#define TIME_1sec // ROSA_TIME_1sec() //#define TIME_SYSTEM // ROSA_TIME_SETUP() #define STRING_LENGTH 25/*********************************************************** // Include ************************************************************/ #include ".\ROSA\ROSA_BASE.cpp" #include ".\ROSA\ROSA_LINK.cpp" #include ".\ROSA\ROSA_SENSOR.cpp" #include ".\ROSA\ROSA_SERVO.cpp" ROSA_LINK link; ROSA_SONAR sonar; ROSA_SERVO servo; /*********************************************************** // Main Program ************************************************************/ void setup() { link.USB_SETUP(115200); // pin 1, 0 TX, RX USB, 115200 baud sonar.SETUP(12, 11); // pin trig, echo servo.SETUP(9); // pin 9 } void loop() { ROSA_TIME_RUNNING(); // 系統時間處理 } /*********************************************************** // SYSTEM TIMER ************************************************************/ void ROSA_TIME_50ms() { servo.PROCESS(); // 伺服馬達處理 } void ROSA_TIME_500ms() { int cm = sonar.DETECT(); // 超音波偵測 link.PRINT(STRING("Distance : %d cm\n", cm)); // 印出以便偵錯 if (cm < 25) { // 接近時開動 servo.setAngle = 180; servo.hold = HOLDON; } else if (cm > 100) { // 遠離時關閉 servo.setAngle = 0; servo.hold = 0; } }
