// 掌控者 PS4/PS5 × mBlock 5　範例 2：按鍵亮燈（mBot 等價 Arduino 程式）
// 接線：藍牙接收器 → mBot 插座片 → mBot 連接埠 4。第一次使用先照「開始之前」配對手把；之後按手把的 PS 鍵就會自動連上。
// 跟 mBlock 積木範例做的事完全一樣，給想看「積木背後長什麼樣」或用 Arduino IDE 的人。
// 需要的函式庫：
//   1. Makeblock（Arduino IDE「函式庫管理員」搜尋 Makeblock，或 mBlock 5 安裝資料夾裡的 Makeblock 函式庫）
//   2. MBC_Sensors v2：擴展 .mext 解壓後的 src/ 四個檔（MBC_Sensors.h/.cpp、mbc_proto.h、mbc_ids.h），
//      放進 文件/Arduino/libraries/MBC_Sensors/ 就能 #include <MBC_Sensors.h>（https://mbc-pro-sensors.github.io/makeblock.html）
// 主板選 Arduino Uno（mBot 的 mCore 就是 Uno），上傳後拔掉 USB 用電池跑。

#include <MeMCore.h>            // mBot（mCore）：馬達、LED、蜂鳴器
#include <SoftwareSerial.h>
#include <MBC_Sensors.h>        // MBC 感應器 v2（跟 mBlock 擴展同一份函式庫）

MBCPort mbc_port4(4);           // 感應器接在 mBot 連接埠 4
MeDCMotor motorL(9);           // 左輪（M1）
MeDCMotor motorR(10);          // 右輪（M2）
MeRGBLed rgbled(7, 2);         // 板載 RGB LED（2 顆）
MeBuzzer buzzer;               // 板載蜂鳴器

// 左／右輪動力 -100~100（正 = 往前）：mBot 的左輪裝反，所以 M1 給負的；% 換算成 PWM 0~255
void wheels(int l, int r) {
  l = constrain(l, -100, 100); r = constrain(r, -100, 100);
  motorL.run(-l * 255 / 100);
  motorR.run(r * 255 / 100);
}

void setup() {   // 跟 mBlock 產生的程式一樣，積木全部在 setup() 裡跑
  mbc_port4.begin();
  delay(1000);   // 等 1 秒讓接收器開機
  while (1) {   // 一直重複
    if (mbcPadPressed(mbc_port4, 12)) {   // 如果 ▲ 被按下
      rgbled.setColor(0, 0, 255, 0); rgbled.show();   // ▲：綠燈
    } else {
      if (mbcPadPressed(mbc_port4, 13)) {   // 否則，如果 ● 被按下
        rgbled.setColor(0, 255, 0, 0); rgbled.show();   // ●：紅燈
      } else {
        if (mbcPadPressed(mbc_port4, 14)) {   // 否則，如果 Ⅹ 被按下
          rgbled.setColor(0, 0, 0, 255); rgbled.show();   // Ⅹ：藍燈
        } else {
          if (mbcPadPressed(mbc_port4, 15)) {   // 否則，如果 ■ 被按下
            rgbled.setColor(0, 255, 0, 255); rgbled.show();   // ■：粉紅燈
          } else {
            rgbled.setColor(0, 0, 0, 0); rgbled.show();   // 都沒按：關燈
          }
        }
      }
    }
  }
}

void loop() {}   // 這裡什麼都沒有：上面的積木不會結束