初版

寝落ちするランプロボット LIGHTONY【SPRESENSE × 音声認識】

製作品

(MIT) The MIT License

# はじめに 電気をつけっぱなしで寝てしまった夜には、一緒に寝落ちして電気を消してくれる。 電気のスイッチを消すために布団から出るのが億劫な時にも「おやすみ」と言えばそっと電気を消してくれる。 そんなランプがあったら素敵だなと思い立ち、 音声認識機能付き寝落ちランプロボット「LIGHTONY」を開発しました。  今回開発を行ったLIGHTONYは寝落ちするランプロボットの一つの形に過ぎません。 本記事を参考に独自の音声認識機能付き寝落ちランプロボットの開発に取り組んで頂けたら幸いです。  # 概要 本記事は前編と後編に分かれた構成となっております。 前編は秋月電子やAmazonで販売されている部品中心で選定を行ったため、比較的再現を行い易い構成であると考えています。 後編は配線や電池を含む全部品を体内へと組込み、インテリア用ロボットとしての完成形を目指す内容です。 # 前編 ## ハードウェア ### 材料 |品名|員数|用途|購入先| |:---:|:---:|:---:|:---:|:---:| |SPRESENSE メインボード|1|制御用基板|秋月電子| |SPRESENSE 拡張ボード|1|制御用基板|秋月電子| |NJU211M|1|LED ON/OFF, 調光用アナログスイッチ|秋月電子| |AE-SOP16|1|NJU211M用変換基板|秋月電子| |抵抗 2.2kΩ|2|マイク用バイアス抵抗|秋月電子| |抵抗 100kΩ|1|LED 制御用プルアップ抵抗|秋月電子| |抵抗 270kΩ|1|LED 調光用抵抗|秋月電子| |抵抗 510kΩ|2|LED 調光用抵抗※並列接続により255kΩとして使用|秋月電子| |抵抗 1MΩ|1|LED 調光用抵抗|秋月電子| |ピンヘッダ(2.54mmピッチ)|1|各種配線用|秋月電子| |ECM-SP10|2|音声認識用マイク|Amazon| |CK-42|2|マイク用変換基板|Amazon| |RS304MD|2|瞼, 首(ヨー軸)用サーボ|Amazon| |RS303MR|1|首(ピッチ軸)用サーボ|Amazon| |LEDフィラメント電球(12V/6W)|1|頭部用LED|Amazon| |HS-L2615ZR/W|1|電球搭載用ソケット|Amazon| |ロッカースイッチ|1|サーボ, LED用電源スイッチ|Amazon| |単3×4 電池ボックス|1|サーボ, LED用電源|Amazon| |eneloop pro BK-3HCD/4H|1|サーボ, LED用電源|Amazon| |microSDカード 32GB|1|音声認識制御用|Amazon| |LTC3119 DCDCコンバーターモジュール|1|LED点灯制御用電源基板|Strawberry Linux| ### 配線図 LEDのON/OFF制御のみであればパターン1、 LEDに調光機能を持たせる場合はパターン2にて配線。   配線が完了し、バラック基板が完成しました。  ロボット側も各部位に対して、マイク、LED、サーボモータの組込みが完了しました。  ロボットとバラック基板間の接続を行い、ハードウェアは完成となります。 ## ソフトウェア ### 動作内容 **マイク入力による動作** |音声(音)コマンド|動作内容|点灯状態|条件| |:---:|:---:|:---:|:---:| |起きて|ゆっくりと目を開けながら点灯、話者にお辞儀|最大点灯|寝ている時のみ反応| |おやすみ|ゆっくりと目を閉じた後、首をすぼめながら消灯|消灯|起きている時のみ反応| |暗くして|頷いた後、減光させながら目を半分閉じる|最小点灯|起きている&最大点灯時のみ反応| |明るくして|頷いた後、増光させながら目を完全に開く|最大点灯|起きている&最小点灯時のみ反応| |（手拍子の音）|勢いよく首を持ち上げながら点灯、驚いたように瞬きを行う|最大点灯|寝ている時のみ反応| |（息を吹きかける音）|半目状態で減光増光を繰り返した後、ゾワッとするように首を左右に振る|最小点灯|なし| **その他の動作** |動作名|動作内容|点灯状態|条件| |:---:|:---:|:---:|:---:| |うとうと（寝落ち）|首をこくんこくんと前後に振りながら、目を徐々に閉じる|消灯|起きている時、最後のマイク入力から180秒後に実行| |瞬き|瞬きを行う|直前の点灯状態を維持|起きている時、15秒おきに実行| ### DSPファイルの準備 SpresenseのFFTライブラリを使用するため以下の手順でDSPファイルのインストールを実施します。 1. Arduino IDEを開く 2. ファイル/スケッチ例/Audio/src_installerを選択 3. Spresenseへsrc_installerを書き込み 4. シリアルモニターを開く 5. シリアルモニターの出力内容に沿ってDSPファイルをインストール 上記の手順は「SPRESENSEではじめるローパワーエッジAI」を参照しています。 ### 学習データの作成 学習データを作成するためのスケッチ。 ``` #ifdef SUBCORE #error "Core selection is wrong!!" #endif #include <Audio.h> #include <FFT.h> #define FFT_LEN 512 // ステレオ、512サンプルでFFTを初期化 FFTClass<AS_CHANNEL_STEREO, FFT_LEN> FFT; AudioClass* theAudio = AudioClass::getInstance(); #include <MP.h> #include <MPMutex.h> // サブコア間の同期ライブラリ MPMutex mutex(MP_MUTEX_ID0); const int subcore = 1; // サブコアの番号 #include <SDHCI.h> SDClass SD; File myFile; #include <float.h> // FLT_MAX, FLT_MIN #include <BmpImage.h> BmpImage bmp; // ===================== パラメータ定義 ===================== static const int frames = 40; // 時間方向（内部保持列数） 6+28+6 static const int fft_samples = 96; // 周波数方向（使用bin数 0..約3kHz想定） static const int pre_frames = 6; // 無音プリ static const int target_frames = 28; // 発話区間（抽出・保存対象） static const int post_frames = 6; // 無音ポスト static const int time_cols = target_frames; // BMP横幅 28（=target） static const int freq_rows = 48; // BMP縦幅 96→2bin平均で48 static const float alpha = 0.8f; // Rch抑圧係数（環境音抑圧） static const float sound_th = 70.f; // 発話しきい値（総エネルギー） static const float silent_th = 10.f; // 無音しきい値 // ===================== 平滑化（4フレーム移動平均） ===================== void averageSmooth(float* dst) { const int array_size = 4; static float pArray[array_size][FFT_LEN/2]; static int g_counter = 0; if (g_counter == array_size) g_counter = 0; for (int i = 0; i < FFT_LEN/2; ++i) { pArray[g_counter][i] = dst[i]; float sum = 0; for (int j = 0; j < array_size; ++j) { sum += pArray[j][i]; } dst[i] = sum / array_size; } ++g_counter; } void setup() { Serial.begin(115200); pinMode(LED_BUILTIN, OUTPUT); digitalWrite(LED_BUILTIN, LOW); while (!SD.begin()) { Serial.println("insert SD card"); } FFT.begin(WindowHamming, AS_CHANNEL_STEREO, (FFT_LEN/2)); Serial.println("Init Audio Recorder"); theAudio->begin(); theAudio->setRecorderMode(AS_SETRECDR_STS_INPUTDEVICE_MIC); int err = theAudio->initRecorder(AS_CODECTYPE_PCM, "/mnt/sd0/BIN", AS_SAMPLINGRATE_16000, AS_CHANNEL_STEREO); if (err != AUDIOLIB_ECODE_OK) { Serial.println("Recorder initialize error"); while (1); } Serial.println("Start Recorder"); theAudio->startRecorder(); // 録音開始 MP.begin(subcore); // サブコア開始 } void loop() { static const uint32_t buffering_time = FFT_LEN * 1000 / AS_SAMPLINGRATE_16000; // ≒ 32ms static const uint32_t buffer_size = FFT_LEN * sizeof(int16_t) * AS_CHANNEL_STEREO; static char buff[buffer_size]; static float pDstFG[FFT_LEN]; static float pDstBG[FFT_LEN]; static float pDst[FFT_LEN/2]; static float spc_data[frames * fft_samples]; static float hist[frames]; uint32_t read_size; int ret; ret = theAudio->readFrames(buff, buffer_size, &read_size); if (ret != AUDIOLIB_ECODE_OK && ret != AUDIOLIB_ECODE_INSUFFICIENT_BUFFER_AREA) { Serial.println(String("Error err = ") + String(ret)); theAudio->stopRecorder(); while (1); } if (read_size < buffer_size) { delay(buffering_time); return; } FFT.put((q15_t*)buff, FFT_LEN); FFT.get(pDstFG, 0); // MIC-A FFT.get(pDstBG, 1); // MIC-B for (int f = 0; f < FFT_LEN/2; ++f) { float v = pDstFG[f] - alpha * pDstBG[f]; pDst[f] = v < 0.f ? 0.f : v; } averageSmooth(pDst); for (int t = 1; t < frames; ++t) { float* dst = spc_data + (t-1) * fft_samples; float* src = spc_data + t * fft_samples; memcpy(dst, src, fft_samples * sizeof(float)); hist[t-1] = hist[t]; } float sound_power_nc = 0.f; for (int f = 0; f < FFT_LEN/2; ++f) sound_power_nc += pDst[f]; hist[frames-1] = sound_power_nc; float* sp_last = spc_data + (frames-1) * fft_samples; memcpy(sp_last, pDst, fft_samples * sizeof(float)); float pre_area = 0.f, target_area = 0.f, post_area = 0.f; for (int t = 0; t < frames; ++t) { if (t < pre_frames) pre_area += hist[t]; else if (t < pre_frames + target_frames) target_area += hist[t]; else post_area += hist[t]; } if (pre_area < silent_th && target_area >= sound_th && post_area < silent_th) { memset(hist, 0, sizeof(hist)); uint8_t bmp_data[time_cols * freq_rows]; float spmax = FLT_MIN, spmin = FLT_MAX; for (int n = 0; n < frames * fft_samples; ++n) { float v = spc_data[n]; if (v > spmax) spmax = v; if (v < spmin) spmin = v; } float denom = spmax - spmin; if (denom < 1e-9f) denom = 1e-9f; int row = freq_rows - 1; for (int f = 0; f < fft_samples; f += 2) { int col = 0; for (int t = pre_frames; t < pre_frames + target_frames; ++t) { float v0 = (spc_data[fft_samples * t + f ] - spmin) / denom; float v1 = (spc_data[fft_samples * t + f + 1] - spmin) / denom; float v = (v0 + v1) * 0.5f * 255.f; if (v < 0.f) v = 0.f; if (v > 255.f) v = 255.f; bmp_data[time_cols * row + col] = (uint8_t)(v + 0.5f); ++col; } --row; } digitalWrite(LED_BUILTIN, HIGH); theAudio->stopRecorder(); bool saved = false; do { static int n = 0; char fname[32]; memset(fname, 0, sizeof(fname)); sprintf(fname, "%03d.bmp", n++); if (SD.exists(fname)) SD.remove(fname); File myFile = SD.open(fname, FILE_WRITE); if (!myFile) { Serial.println("SD open failed"); break; } bmp.begin(BmpImage::BMP_IMAGE_GRAY8, time_cols, freq_rows, bmp_data); size_t expect_min = 2200; size_t written = myFile.write(bmp.getBmpBuff(), bmp.getBmpSize()); myFile.close(); bmp.end(); Serial.print("bmp size: "); Serial.println(bmp.getBmpSize()); Serial.print("written: "); Serial.println(written); Serial.println(String("save image as ") + fname); if (written > expect_min) saved = true; else Serial.println("Warning: written size too small"); } while (0); theAudio->startRecorder(); digitalWrite(LED_BUILTIN, LOW); if (!saved) { Serial.println("save failed"); } } if (mutex.Trylock() != 0) return; int8_t sndid = 100; static const int disp_samples = 96; static float data[disp_samples]; memcpy(data, pDst, disp_samples * sizeof(float)); ret = MP.Send(sndid, &data, subcore); if (ret < 0) MPLog("FFT data Send Error\n"); mutex.Unlock(); } ``` こちらのスケッチは「SPRESENSEではじめるローパワーエッジAI」を参考に作成しています。 同書籍にて紹介されているスケッチに対して、より長い音声コマンドを使用するためにフレーム数の変更を行なっています。 ### 学習済モデルの生成 ニューラルネットワークの構成  学習の結果  ### メインプログラム 以下は実際にLIGHTONYを動かすためのスケッチです。 ```main.ino #ifdef SUBCORE #error "Core selection is wrong!!" #endif #include <Audio.h> #include <FFT.h> #include <SDHCI.h> #include <float.h> #include <DNNRT.h> #include <Servo.h> // ----------------------------------------------------------------------------- // Compile-time constants and global library objects // ----------------------------------------------------------------------------- #define FFT_LEN 512 #define NNB_FILE "model.nnb" #define BUFFERING_TIME_MS (FFT_LEN * 1000 / AS_SAMPLINGRATE_16000) #define BUFFER_SIZE_BYTES (FFT_LEN * sizeof(int16_t) * AS_CHANNEL_STEREO) FFTClass<AS_CHANNEL_STEREO, FFT_LEN> FFT; AudioClass* theAudio = AudioClass::getInstance(); SDClass SD; DNNRT dnnrt; // ========================= // Types: Step, Sequence // ========================= enum Level : int8_t { LEVEL_KEEP = -1, LEVEL_OFF = 0, LEVEL_LOW, LEVEL_MID, LEVEL_HIGH, LEVEL_FULL }; struct Step { int eyelidDeg; int pitchDeg; int yawDeg; uint16_t stepDelayMs; uint16_t holdMs; Level level; }; struct Sequence { const Step* steps; int count; }; // ========================= // SmoothServo // ========================= struct SmoothServo { Servo s; int cur, target; uint16_t stepMs; unsigned long lastMs; SmoothServo(int initAngle = 90) : cur(initAngle), target(initAngle), stepMs(10), lastMs(0) {} void attach(int pin) { s.attach(pin); s.write(cur); } void setTarget(int t, uint16_t ms) { target = constrain(t, 0, 180); stepMs = (ms == 0) ? 1 : ms; } void update(unsigned long now) { if (cur == target) return; if ((now - lastMs) >= stepMs) { lastMs = now; int stepSize = 1; if (stepMs <= 1) stepSize = 12; else if (stepMs <= 3) stepSize = 8; else if (stepMs <= 8) stepSize = 4; else if (stepMs <= 20) stepSize = 2; int diff = target - cur; if (diff > 0) cur += min(stepSize, diff); else cur -= min(stepSize, -diff); cur = constrain(cur, 0, 180); s.write(cur); } } bool moving() const { return cur != target; } }; // サーボ初期角度 SmoothServo Eyelid(112), Pitch(97), Yaw(95); // ========================= // Level pins / table // ========================= static const uint8_t kLevelPins[] = {4, 10, 11, 12, 13}; static const int kLevelPinCount = (int)(sizeof(kLevelPins) / sizeof(kLevelPins[0])); struct LevelPattern { Level level; uint8_t pinState[5]; }; static const LevelPattern kLevelTable[] = { { LEVEL_FULL, {HIGH, LOW, HIGH, HIGH, HIGH} }, { LEVEL_HIGH, {HIGH, HIGH, LOW, HIGH, HIGH} }, { LEVEL_MID, {HIGH, HIGH, HIGH, LOW, HIGH} }, { LEVEL_LOW, {HIGH, HIGH, HIGH, HIGH, LOW } }, { LEVEL_OFF, {LOW, HIGH, HIGH, HIGH, HIGH} }, }; static Level g_currentLevel = LEVEL_OFF; static inline void applyLevel(Level lv) { for (size_t t = 0; t < sizeof(kLevelTable) / sizeof(kLevelTable[0]); ++t) { if (kLevelTable[t].level != lv) continue; for (int i = 0; i < kLevelPinCount; ++i) digitalWrite(kLevelPins[i], kLevelTable[t].pinState[i]); g_currentLevel = lv; return; } // fallback for (int i = 0; i < kLevelPinCount; ++i) digitalWrite(kLevelPins[i], HIGH); digitalWrite(kLevelPins[0], LOW); g_currentLevel = LEVEL_OFF; } // ========================= // Sequences // ========================= const Step seqA[] = { {100,97,95,50,50,LEVEL_KEEP},{85,87,95,70,0,LEVEL_LOW},{85,87,95,1,50,LEVEL_MID}, {85,87,95,1,50,LEVEL_HIGH},{100,97,95,70,500,LEVEL_FULL},{85,87,95,70,0,LEVEL_LOW}, {85,87,95,1,50,LEVEL_MID},{85,87,95,1,50,LEVEL_HIGH},{97,96,95,80,500,LEVEL_FULL}, {88,91,95,120,700,LEVEL_HIGH},{88,91,95,1,50,LEVEL_MID},{88,91,95,1,50,LEVEL_LOW}, {80,87,95,50,50,LEVEL_OFF} }; const Step seqB[] = { {112,97,95,10,700,LEVEL_FULL},{90,97,95,1,70,LEVEL_FULL},{112,97,95,1,70,LEVEL_FULL}, {90,97,95,1,70,LEVEL_FULL},{112,97,95,1,70,LEVEL_FULL} }; const Step seqC[] = { {112,97,95,60,100,LEVEL_FULL},{112,90,95,60,100,LEVEL_FULL},{112,97,95,60,500,LEVEL_FULL}, {104,97,95,60,500,LEVEL_HIGH},{104,97,95,50,100,LEVEL_MID},{104,97,95,1,1000,LEVEL_LOW} }; const Step seqD[] = { {104,97,95,60,100,LEVEL_LOW},{104,90,95,60,100,LEVEL_LOW},{104,97,95,60,500,LEVEL_LOW}, {112,97,95,40,500,LEVEL_MID},{112,97,95,50,100,LEVEL_HIGH},{112,97,95,1,100,LEVEL_FULL} }; const Step seqE[] = { {102,97,95,15,100,LEVEL_OFF},{102,97,95,1,100,LEVEL_LOW},{102,97,95,1,100,LEVEL_MID}, {102,97,95,1,100,LEVEL_HIGH},{102,97,95,1,100,LEVEL_FULL},{102,97,95,1,100,LEVEL_HIGH}, {102,97,95,1,100,LEVEL_MID},{102,97,95,1,100,LEVEL_LOW},{102,97,95,1,100,LEVEL_MID}, {102,97,95,1,100,LEVEL_HIGH},{102,97,95,1,100,LEVEL_FULL},{102,97,95,1,100,LEVEL_HIGH}, {102,97,95,1,100,LEVEL_LOW},{102,97,95,1,100,LEVEL_MID},{102,97,95,1,100,LEVEL_HIGH}, {102,97,95,1,100,LEVEL_FULL},{102,97,95,1,100,LEVEL_HIGH},{102,97,95,1,100,LEVEL_MID}, {102,97,95,1,100,LEVEL_LOW},{102,97,95,1,100,LEVEL_MID},{102,97,95,1,100,LEVEL_HIGH}, {102,97,95,1,100,LEVEL_FULL},{102,97,95,1,100,LEVEL_HIGH},{102,97,100,15,1,LEVEL_MID}, {102,97,90,15,1,LEVEL_LOW},{102,97,100,15,1,LEVEL_LOW},{102,97,90,15,1,LEVEL_LOW}, {102,97,95,15,70,LEVEL_LOW},{90,97,95,15,70,LEVEL_LOW},{102,97,95,15,70,LEVEL_LOW} }; const Step seqF[] = { {80,87,95,100,500,LEVEL_KEEP},{80,87,100,100,50,LEVEL_KEEP},{80,87,90,50,50,LEVEL_KEEP}, {80,87,100,50,50,LEVEL_KEEP},{80,87,90,50,50,LEVEL_KEEP},{80,87,95,90,400,LEVEL_KEEP}, {80,87,95,90,50,LEVEL_OFF} }; const Step seqG[] = { {112,97,95,50,100,LEVEL_LOW},{90,97,95,5,70,LEVEL_LOW},{112,97,95,5,70,LEVEL_FULL}, {112,97,85,50,100,LEVEL_FULL},{112,90,85,60,400,LEVEL_FULL},{112,97,85,60,150,LEVEL_FULL}, {112,97,95,55,1000,LEVEL_FULL} }; const Step seqH[] = { {90,97,95,1,70,LEVEL_KEEP},{112,97,95,1,70,LEVEL_KEEP} }; const Step seqI[] = { {90,97,95,2,70,LEVEL_KEEP},{104,97,95,2,70,LEVEL_KEEP} }; const Sequence SEQA = { seqA, (int)(sizeof(seqA) / sizeof(seqA[0])) }; const Sequence SEQB = { seqB, (int)(sizeof(seqB) / sizeof(seqB[0])) }; const Sequence SEQC = { seqC, (int)(sizeof(seqC) / sizeof(seqC[0])) }; const Sequence SEQD = { seqD, (int)(sizeof(seqD) / sizeof(seqD[0])) }; const Sequence SEQE = { seqE, (int)(sizeof(seqE) / sizeof(seqE[0])) }; const Sequence SEQF = { seqF, (int)(sizeof(seqF) / sizeof(seqF[0])) }; const Sequence SEQG = { seqG, (int)(sizeof(seqG) / sizeof(seqG[0])) }; const Sequence SEQH = { seqH, (int)(sizeof(seqH) / sizeof(seqH[0])) }; const Sequence SEQI = { seqI, (int)(sizeof(seqI) / sizeof(seqI[0])) }; // ========================= // Runtime state // ========================= const Sequence* activeSeq = nullptr; int activeSeqId = -1; int idx = 0; unsigned long holdStartMs = 0; bool holding = false; bool running = false; bool seqActive[9] = { false }; unsigned long lastInteractionMs = 0; const unsigned long IDLE_TIMEOUT_MS = 60000UL; const unsigned long DETECT_DEBOUNCE_MS = 800; unsigned long lastDetectMs = 0; int lastCompletedSeqId = -1; unsigned long lastCompletedMs = 0; // SEQH/SEQI を除く最後の完了時刻（SEQA 自動起動判定用） unsigned long lastNonBlinkCompletedMs = 0; // SEQH / SEQI periodic timers unsigned long lastBlinkHMs = 0; unsigned long lastBlinkIMs = 0; const unsigned long BLINK_INTERVAL_MS = 15000UL; // 15s // SEQA auto after last non-blink (180s) const unsigned long AUTO_AFTER_LAST_MS = 180000UL; static const char* kLabels[] = {"wake_up","good_night","brightly","darkly","clap","blow"}; static const int kNumLabels = 6; static float labelThresholds[kNumLabels] = {0.50f,0.50f,0.50f,0.50f,0.50f,0.50f}; // spectrogram buffers static const int frames = 40; static const int fft_samples = 96; static float spc_data[frames * fft_samples]; static float hist[frames]; static const uint32_t buffering_time = BUFFERING_TIME_MS; static const uint32_t buffer_size = BUFFER_SIZE_BYTES; static char buff[BUFFER_SIZE_BYTES]; static float pDstFG[FFT_LEN]; static float pDstBG[FFT_LEN]; static float pDst[FFT_LEN / 2]; // ========================= // Helpers: startStep, getSequenceById, startSequence, stopSequence // ========================= void startStep(int i) { const Step& st = activeSeq->steps[i]; Eyelid.setTarget(st.eyelidDeg, st.stepDelayMs); Pitch.setTarget(st.pitchDeg, st.stepDelayMs); Yaw.setTarget(st.yawDeg, st.stepDelayMs); if (st.level != LEVEL_KEEP) applyLevel(st.level); holding = false; } const Sequence* getSequenceById(int id) { switch (id) { case 0: return &SEQA; case 1: return &SEQB; case 2: return &SEQC; case 3: return &SEQD; case 4: return &SEQE; case 5: return &SEQF; case 6: return &SEQG; case 7: return &SEQH; case 8: return &SEQI; default: return nullptr; } } void startSequence(const Sequence* seq, int seqId) { if (running) return; // block rules (original mapping) bool blocked = false; switch (lastCompletedSeqId) { case 0: if (seqId==0||seqId==2||seqId==3||seqId==5||seqId==7||seqId==8) blocked = true; break; case 1: if (seqId==1||seqId==3||seqId==6||seqId==8) blocked = true; break; case 2: if (seqId==2||seqId==6||seqId==7) blocked = true; break; case 3: if (seqId==3||seqId==6||seqId==8) blocked = true; break; case 4: if (seqId==2||seqId==6||seqId==7) blocked = true; break; case 5: if (seqId==0||seqId==2||seqId==3||seqId==5||seqId==7||seqId==8) blocked = true; break; case 6: if (seqId==1||seqId==3||seqId==6||seqId==8) blocked = true; break; case 7: if (seqId==1||seqId==3||seqId==6||seqId==8) blocked = true; break; case 8: if (seqId==1||seqId==2||seqId==6||seqId==7) blocked = true; break; default: break; } if (blocked) return; activeSeq = seq; activeSeqId = seqId; idx = 0; running = true; if (seqId >= 0 && seqId < 9) seqActive[seqId] = true; startStep(idx); Serial.print("sequence started id="); Serial.println(seqId); lastInteractionMs = millis(); } void stopSequence() { running = false; activeSeq = nullptr; holding = false; if (activeSeqId >= 0 && activeSeqId < 9) seqActive[activeSeqId] = false; activeSeqId = -1; for (int i = 0; i < 9; ++i) seqActive[i] = false; applyLevel(LEVEL_OFF); Serial.println("sequence stopped"); lastInteractionMs = millis(); } // ========================= // setup // ========================= void setup() { for (int i = 0; i < kLevelPinCount; ++i) pinMode(kLevelPins[i], OUTPUT); // apply LEVEL_FULL at startup for (size_t t = 0; t < sizeof(kLevelTable) / sizeof(kLevelTable[0]); ++t) { if (kLevelTable[t].level != LEVEL_FULL) continue; for (int i = 0; i < kLevelPinCount; ++i) digitalWrite(kLevelPins[i], kLevelTable[t].pinState[i]); g_currentLevel = LEVEL_FULL; break; } Eyelid.attach(3); Pitch.attach(6); Yaw.attach(5); Serial.begin(115200); unsigned long sdStart = millis(); const unsigned long SD_TIMEOUT_MS = 10000UL; while (!SD.begin()) { if (millis() - sdStart > SD_TIMEOUT_MS) { Serial.println("SD init timeout"); delay(1000); sdStart = millis(); } } File nnbfile = SD.open(NNB_FILE); if (!nnbfile) { Serial.println("nnb not found"); while (1) delay(1000); } int ret = dnnrt.begin(nnbfile); nnbfile.close(); if (ret < 0) { Serial.println("DNN init error"); while (1) delay(1000); } FFT.begin(WindowHamming, AS_CHANNEL_STEREO, (FFT_LEN / 2)); theAudio->begin(); theAudio->setRecorderMode(AS_SETRECDR_STS_INPUTDEVICE_MIC); int err = theAudio->initRecorder(AS_CODECTYPE_PCM, "/mnt/sd0/BIN", AS_SAMPLINGRATE_16000, AS_CHANNEL_STEREO); if (err != AUDIOLIB_ECODE_OK) { Serial.println("Recorder init error"); while (1) delay(1000); } theAudio->startRecorder(); memset(spc_data, 0, sizeof(spc_data)); memset(hist, 0, sizeof(hist)); lastInteractionMs = millis(); lastBlinkHMs = millis(); lastBlinkIMs = millis(); lastNonBlinkCompletedMs = 0; } // ========================= // loop // ========================= void loop() { unsigned long now = millis(); // minimal serial commands while (Serial.available()) { char c = Serial.read(); if (c == '\r' || c == '\n') continue; lastInteractionMs = now; if (c == 's') { stopSequence(); continue; } if (c == 'r') { if (activeSeqId >= 0 && activeSeqId < 9) { const Sequence* seq = getSequenceById(activeSeqId); if (seq) startSequence(seq, activeSeqId); } continue; } if (!running) { if (c == 'a') startSequence(&SEQA, 0); else if (c == 'b') startSequence(&SEQB, 1); else if (c == 'c') startSequence(&SEQC, 2); else if (c == 'd') startSequence(&SEQD, 3); else if (c == 'e') startSequence(&SEQE, 4); else if (c == 'f') startSequence(&SEQF, 5); else if (c == 'g') startSequence(&SEQG, 6); else if (c == 'h') startSequence(&SEQH, 7); else if (c == 'i') startSequence(&SEQI, 8); } } // SEQA auto-start: 45s after last non-blink completed if (!running && lastNonBlinkCompletedMs != 0) { if (now - lastNonBlinkCompletedMs >= AUTO_AFTER_LAST_MS) { startSequence(&SEQA, 0); } } // SEQH periodic auto-run (17s), skip if lastCompletedSeqId == 4 (blow) if (!running && (now - lastBlinkHMs >= BLINK_INTERVAL_MS) && lastCompletedSeqId != 4) { startSequence(&SEQH, 7); if (running && activeSeqId == 7) lastBlinkHMs = now; } // SEQI periodic auto-run (17s), skip if lastCompletedSeqId == 4 (blow) if (!running && (now - lastBlinkIMs >= BLINK_INTERVAL_MS) && lastCompletedSeqId != 4) { startSequence(&SEQI, 8); if (running && activeSeqId == 8) lastBlinkIMs = now; } // servo updates Eyelid.update(now); Pitch.update(now); Yaw.update(now); if (running) { if (Eyelid.moving() || Pitch.moving() || Yaw.moving()) { // wait for servos } else { if (!holding) { holding = true; holdStartMs = now; } if ((now - holdStartMs) >= (activeSeq ? activeSeq->steps[idx].holdMs : 0)) { if (activeSeq) { idx++; if (idx >= activeSeq->count) { if (activeSeqId >= 0 && activeSeqId < 9) seqActive[activeSeqId] = false; lastCompletedSeqId = activeSeqId; lastCompletedMs = now; // update lastNonBlinkCompletedMs only if not blink sequences (7 or 8) if (lastCompletedSeqId != 7 && lastCompletedSeqId != 8) { lastNonBlinkCompletedMs = now; } running = false; activeSeq = nullptr; activeSeqId = -1; Serial.print("sequence finished id="); Serial.println(lastCompletedSeqId); lastInteractionMs = now; } else { startStep(idx); } } } } } // ====== audio frame read ====== uint32_t read_size = 0; int ret = theAudio->readFrames(buff, buffer_size, &read_size); if (ret != AUDIOLIB_ECODE_OK && ret != AUDIOLIB_ECODE_INSUFFICIENT_BUFFER_AREA) { while (1) delay(1000); } if (read_size < buffer_size) { delay(buffering_time); return; } // ====== FFT ====== FFT.put((q15_t*)buff, FFT_LEN); FFT.get(pDstFG, 0); FFT.get(pDstBG, 1); // MIC-A/B diff + clamp const float alpha = 0.8f; for (int f = 0; f < FFT_LEN / 2; ++f) { float v = pDstFG[f] - alpha * pDstBG[f]; pDst[f] = (v < 0.0f) ? 0.0f : v; } // smoothing (moving average) const int array_size = 4; static float pArray[array_size][FFT_LEN / 2]; static int g_counter = 0; if (g_counter == array_size) g_counter = 0; for (int i = 0; i < FFT_LEN / 2; ++i) { pArray[g_counter][i] = pDst[i]; float sum = 0; for (int j = 0; j < array_size; ++j) sum += pArray[j][i]; pDst[i] = sum / array_size; } ++g_counter; // spectrogram shift memmove(spc_data, spc_data + fft_samples, (frames - 1) * fft_samples * sizeof(float)); memmove(hist, hist + 1, (frames - 1) * sizeof(float)); float sound_power_nc = 0.0f; for (int f = 0; f < FFT_LEN / 2; ++f) sound_power_nc += pDst[f]; hist[frames - 1] = sound_power_nc; float* sp_last = spc_data + (frames - 1) * fft_samples; memcpy(sp_last, pDst, fft_samples * sizeof(float)); // VAD (pre/target/post = 6/28/6) const float sound_th = 70.0f; const float silent_th = 10.0f; float pre_area = 0.0f, target_area = 0.0f, post_area = 0.0f; for (int t = 0; t < frames; ++t) { if (t < 6) pre_area += hist[t]; else if (t < 6 + 28) target_area += hist[t]; else post_area += hist[t]; } if (pre_area < silent_th && target_area >= sound_th && post_area < silent_th) { unsigned long now3 = millis(); if (now3 - lastDetectMs < DETECT_DEBOUNCE_MS) { // ignore } else { lastDetectMs = now3; memset(hist, 0, sizeof(hist)); // prepare DNN input float spmax = -FLT_MAX, spmin = FLT_MAX; for (int n = 0; n < frames * fft_samples; ++n) { float v = spc_data[n]; if (v > spmax) spmax = v; if (v < spmin) spmin = v; } float denom = spmax - spmin; if (denom < 1e-9f) denom = 1e-9f; DNNVariable input(28 * 48); float* din = input.data(); const int t_begin = 6; const int t_end = 6 + 28; int bf = (fft_samples / 2) - 1; for (int f = 0; f < fft_samples; f += 2) { int bt = 0; for (int t = t_begin; t < t_end; ++t) { float v0 = (spc_data[fft_samples * t + f] - spmin) / denom; float v1 = (spc_data[fft_samples * t + f + 1] - spmin) / denom; float v01 = 0.5f * (v0 + v1); if (v01 < 0.f) v01 = 0.f; if (v01 > 1.f) v01 = 1.f; din[28 * bf + bt] = v01; ++bt; } --bf; } // inference dnnrt.inputVariable(input, 0); dnnrt.forward(); DNNVariable output = dnnrt.outputVariable(0); int index = -1; float value = -1.0f; int out_size = output.size(); float* out_data = output.data(); if (out_size > 0) { index = 0; value = out_data[0]; for (int i = 1; i < out_size; ++i) { if (out_data[i] > value) { value = out_data[i]; index = i; } } if (index < 0 || index >= kNumLabels) index = -1; else if (value < labelThresholds[index]) index = -1; } lastInteractionMs = now3; // minimal serial: detection result and sequence mapping if (index >= 0 && index < kNumLabels) { Serial.print(kLabels[index]); Serial.print(" : "); Serial.println(value, 6); switch (index) { case 0: startSequence(&SEQG, 6); break; case 1: startSequence(&SEQF, 5); break; case 2: startSequence(&SEQD, 3); break; case 3: startSequence(&SEQC, 2); break; case 4: startSequence(&SEQB, 1); break; case 5: startSequence(&SEQE, 4); break; default: break; } } else { Serial.print("class#"); Serial.print(index); Serial.print(" : "); Serial.println(value, 6); } } } } ``` 本スケッチは後編で開発する基板用に最適化を行なっているため、一部の調光機能は使用できませんが基本動作への支障はありません。 # 後編 ## 概要 前編で製作した原理試作ボードの小型化が主な内容となります。 ## 回路 制御基板と電源基板の2枚構成となっております。 ### 制御基板 搭載箇所：頭部  ### 電源基板 搭載箇所：胴体  ### SPRESENSEの部品載せ替え USB接続を行いながら開発を行う際、5V同士の干渉する懸念があったためSPRESENSE メインボード上のD1を除去しました。 また、拡張ボードに対しても基板上で生成した5Vの給電を行うためにD2の実装を行いました。  以下の回路図から、D1とD2は同型番の部品であることが確認できたため、D1→D2の載せ替えにより対応可能と考えられます。 [https://developer.spresense.sony-semicon.com/development-guides/?page=hw_design&lang=ja](url) ## ロボットへの組込み 基板製造、実装も完了し無事にLIGHTONYの体内へと全要素が組み込まれました。  ## 動作確認 音声コマンドによって灯りを点けたり消したり、一定時間経過時にうとうとしてから寝落ちしたり、 思い描いていた音声認識機能付き寝落ちランプロボット「LIGHTONY」がついに完成しました。 @[youtube](https://www.youtube.com/embed/HmzlsDdo05Y) ## こだわりポイントの紹介 本気で一緒に生活できるロボットを目指す上で容易に電池交換が行えることは非常に大切な要素と考えていたため、電池ボックスの取り付け構造も小さなこだわりポイントです。  ふ〜と耳に息を吹きかけられて嫌がると言った動作を取り入れるため、人間の耳に近い位置にマイクを持ってきたこともこだわりポイントです。  # おわりに 実は過去にもLIGHTONYの開発に挑戦したことがありました。 その際はRaspberry Pi上で音声認識ライブラリVoskを動かし、文字起こしされた内容に対して処理を行なっていたため、手拍子や息を吹き込んだ際の風切り音に対するインタラクションを組むことは困難でした。 今回利用した音声のスペクトログラム画像による処理では、音声による処理だけに留まらず、手拍子に対して驚く、ふ〜と耳に息を吹きかけられて嫌がると言った、ロボットのインタラクションとしてもユニークで面白いものに出来たのではないかと感じています。 ロボットへの組み込みの面でもRaspberry Piでの開発時は別体のユニットに制御部分を格納した上、ACアダプター経由での動作となっており、思い描いていたLIGHTONYとは少し違うものに留まっていました。 今回、Spresenseを利用したことにより、電源を含む全ての要素を体内に組み込むことも叶い、思い描いていたLIGHTONYを作り上げられたという実感があります。 さらに作り込んでいきたい妄想を膨らませていますが、非常に満足のいく仕上がりになりました。 何より妻も可愛がってくれているので、2人と1体、仲良く生活していけそうです。