第7章: LEDマトリクス可視化#

UNO R4 WiFi 内蔵の LED マトリクスに OS の内部状態を表示します。

この章で分かること: top やタスクマネージャの CPU % は、どう数えている?

Linux の top や Windows のタスクマネージャには、プログラムごとの CPU 使用率が出ます。 この章の OS も、同じような値を自分で数えて、LED マトリクスとシェルの ps に出します。

数え方は、タイマ割り込みのたびに「そのとき走っていたタスク」に時間を足していく、 というものです。Linux も基本は同じ考え方です。 くわしくは コラム「top と htop」 にまとめました。

LED マトリクスの配線#

96 個の LED は、11 本の線(ROW0〜ROW10)のチャーリープレクシングで つながっています。2 本の線の組ごとに向きが逆の LED が 2 個ついていて、 片方を HIGH・もう片方を LOW にすると 1 個だけが光ります。下の回路図の右上にある表は、 回路図上の LED 番号とマトリクス上の位置の対応です。

付属の Arduino_LED_Matrix ライブラリは、10 kHz のタイマ割り込み 1 回ごとに LED を 1 個ずつ順に点け替えています(96 個で 1 周するので、1 画面あたり 約 104 Hz)。 (Arduino_LED_Matrix.h L182、 L346–L349、 ArduinoCore-renesas 1.5.1)

../_images/uno_r4_wifi_led_matrix_schematic.png

LED マトリクスの回路図。 出典: Arduino, ABX00087 Schematics 2 ページ目「LED MATRIX」(Silvio Navaretti)。 CC BY-SA 4.0#

サンプルコード#

  • ディレクトリ: docs/os-on-arduino/code/07_led_matrix

  • ビルドと書き込み:

uv run pio run -d 07_led_matrix -t upload
uv run pio device monitor -b 115200

コードを見る: docs/os-on-arduino/code/07_led_matrix

ソースコード#

この章のスケッチです。ファイル名をクリックすると開きます。コードは原稿リポジトリから自動で同期されているので、ここに出ているものが常に最新です。

src/main.cpp — 72 行

GitHub で開く

 1// 06_led_matrix.ino
 2// LEDマトリクス可視化のデモ
 3
 4#include "os_kernel.h"
 5#include "os_display.h"
 6#include "shell.h"
 7
 8// Arduino UNO R4 WiFi は基板上に "L" と印字された LED を持っています。
 9// 追加部品なしで動かせるよう、これを主 LED として使います。
10#define LED_PIN LED_BUILTIN
11
12// タスク1: LED点滅(軽い)
13void task_led(void)
14{
15    pinMode(LED_PIN, OUTPUT);
16    while (1) {
17        digitalWrite(LED_PIN, !digitalRead(LED_PIN));
18        os_sleep(200);
19    }
20}
21
22// タスク2: 軽い計算
23void task_light(void)
24{
25    while (1) {
26        volatile int sum = 0;
27        for (int i = 0; i < 10000; i++) {
28            sum += i;
29        }
30        os_sleep(50);
31    }
32}
33
34// タスク3: 重い計算(CPU負荷高い)
35void task_heavy(void)
36{
37    while (1) {
38        volatile long sum = 0;
39        for (long i = 0; i < 500000; i++) {
40            sum += i;
41        }
42        // os_sleep なし:CPUをずっと使う
43    }
44}
45
46void setup()
47{
48    Serial.begin(115200);
49    while (!Serial) { }
50
51    Serial.println("=== LED Matrix Visualization Demo ===");
52    Serial.println("Watch the LED matrix to see OS activity!\n");
53
54    os_init();
55
56    os_create_task(task_led, "LED", 512);
57    os_create_task(task_light, "Light", 512);
58    os_create_task(task_heavy, "Heavy", 512);
59    os_create_task(shell_task, "Shell", 1024);
60    os_create_task(display_task, "Display", 512);
61
62    Serial.println("Legend:");
63    Serial.println("  Top half: CPU load graph (left=old, right=new)");
64    Serial.println("  Bottom half: Task execution (1 row per task)");
65    Serial.println("  Right indicators: RUNNING=11, READY=10, BLOCKED=01\n");
66
67    Serial.println("Try 'kill 3' to stop Heavy task and watch CPU load drop!\n");
68
69    os_start();
70}
71
72void loop() { }
include/os_display.h — 18 行

GitHub で開く

 1// os_display.h
 2
 3#ifndef OS_DISPLAY_H
 4#define OS_DISPLAY_H
 5
 6#include "os_kernel.h"
 7#include "Arduino_LED_Matrix.h"
 8
 9// 表示を初期化
10void display_init(void);
11
12// 表示を更新(定期的に呼ぶ)
13void display_update(void);
14
15// 表示タスク
16void display_task(void);
17
18#endif // OS_DISPLAY_H
include/os_fault.h — 46 行

GitHub で開く

 1/**
 2 * os_fault.h - Fault Handler Header
 3 * Chapter 6: Memory Protection
 4 */
 5
 6#ifndef OS_FAULT_H
 7#define OS_FAULT_H
 8
 9#include <stdint.h>
10
11#ifdef __cplusplus
12extern "C" {
13#endif
14
15// Fault information structure
16typedef struct {
17    uint32_t r0;
18    uint32_t r1;
19    uint32_t r2;
20    uint32_t r3;
21    uint32_t r12;
22    uint32_t lr;
23    uint32_t pc;
24    uint32_t xpsr;
25} FaultFrame;
26
27// Initialize fault handling
28void fault_init(void);
29
30// Get fault reason string
31const char* fault_get_reason(void);
32
33// Check if a fault occurred
34int fault_occurred(void);
35
36// Clear fault flag
37void fault_clear(void);
38
39// Print pending fault info (call from task context, not from ISR)
40void fault_print_pending(void);
41
42#ifdef __cplusplus
43}
44#endif
45
46#endif
include/os_kernel.h — 75 行

GitHub で開く

 1/**
 2 * os_kernel.h - Mini OS Kernel Header
 3 * Chapter 6: Memory Protection with HardFault Handler
 4 */
 5
 6#ifndef OS_KERNEL_H
 7#define OS_KERNEL_H
 8
 9#include <stdint.h>
10
11#ifdef __cplusplus
12extern "C" {
13#endif
14
15typedef enum {
16    TASK_READY,
17    TASK_RUNNING,
18    TASK_BLOCKED,
19    TASK_SUSPENDED,
20    TASK_TERMINATED
21} TaskState;
22
23typedef struct {
24    uint32_t *sp;
25    uint32_t *stack_base;
26    uint32_t stack_size;
27    TaskState state;
28    uint8_t id;
29    uint8_t priority;
30    char name[16];
31    void (*entry)(void);
32    uint32_t wake_tick;
33    uint32_t cpu_ticks;
34} TCB;
35
36#define MAX_TASKS 8
37#define DEFAULT_STACK_SIZE 512
38// タスク用スタックをまとめて置く領域。os_create_task() は
39// ここから要求されたぶんだけ切り出す。
40// 既定より大きなスタックを要求するタスク(シェルなど)があるため、
41// MAX_TASKS * DEFAULT_STACK_SIZE では足りない。余裕を持たせる。
42#define STACK_POOL_SIZE (MAX_TASKS * DEFAULT_STACK_SIZE + 2048)
43#define IDLE_STACK_SIZE 256
44#define TIME_SLICE_MS 10
45
46void os_init(void);
47int os_create_task(void (*entry)(void), const char *name, uint32_t stack_size);
48void os_start(void);
49void os_yield(void);
50void os_sleep(uint32_t ms);
51
52void os_suspend_task(int id);
53void os_resume_task(int id);
54void os_terminate_task(int id);
55
56int os_get_task_count(void);
57const char* os_get_task_name(int id);
58TaskState os_get_task_state(int id);
59int os_get_current_task(void);
60int os_get_cpu_usage(int task_id);
61uint32_t os_get_task_cpu_ticks(int task_id);
62uint32_t os_get_tick(void);
63
64extern TCB g_tasks[MAX_TASKS];
65extern volatile int g_task_count;
66extern volatile int g_current_task;
67extern volatile int g_next_task;
68extern volatile uint32_t g_system_ticks;
69extern const uint32_t g_tcb_size;
70
71#ifdef __cplusplus
72}
73#endif
74
75#endif
include/shell.h — 23 行

GitHub で開く

 1/**
 2 * shell.h - Interactive Shell Header
 3 * Chapter 5: Interactive Shell
 4 */
 5
 6#ifndef SHELL_H
 7#define SHELL_H
 8
 9#ifdef __cplusplus
10extern "C" {
11#endif
12
13// Shell task entry point
14void shell_task(void);
15
16// Process a single command
17void shell_process_command(char *cmd);
18
19#ifdef __cplusplus
20}
21#endif
22
23#endif
src/os_display.cpp — 162 行

GitHub で開く

  1// os_display.cpp
  2
  3#include "os_display.h"
  4#include <Arduino.h>
  5
  6// LEDマトリクスオブジェクト
  7static ArduinoLEDMatrix matrix;
  8
  9// フレームバッファ(8行×12列)
 10static uint8_t frame[8][12];
 11
 12// CPU負荷履歴(12サンプル)
 13static uint8_t cpu_history[12];
 14static int history_index = 0;
 15
 16// タスク実行履歴(4タスク × 8サンプル)
 17#define TASK_HISTORY_LEN 8
 18static int task_history[MAX_TASKS][TASK_HISTORY_LEN];
 19static int task_history_index = 0;
 20
 21void display_init(void)
 22{
 23    matrix.begin();
 24
 25    // フレームバッファをクリア
 26    memset(frame, 0, sizeof(frame));
 27    memset(cpu_history, 0, sizeof(cpu_history));
 28    memset(task_history, -1, sizeof(task_history));
 29}
 30
 31// CPU負荷をパーセントから高さ(0-4)に変換
 32static int cpu_to_height(int cpu_percent)
 33{
 34    if (cpu_percent >= 80) return 4;
 35    if (cpu_percent >= 60) return 3;
 36    if (cpu_percent >= 40) return 2;
 37    if (cpu_percent >= 20) return 1;
 38    return 0;
 39}
 40
 41// フレームバッファにCPU負荷グラフを描画
 42static void draw_cpu_graph(void)
 43{
 44    // 上半分(行0-3)にCPU負荷を描画
 45    for (int col = 0; col < 12; col++) {
 46        int height = cpu_to_height(cpu_history[col]);
 47
 48        for (int row = 0; row < 4; row++) {
 49            // 下から上に向かって描画(行3が底、行0が頂上)
 50            frame[3 - row][col] = (row < height) ? 1 : 0;
 51        }
 52    }
 53}
 54
 55// フレームバッファにタスク実行状態を描画
 56static void draw_task_status(void)
 57{
 58    int task_count = os_get_task_count();
 59
 60    // 最大4タスク表示(行4-7)
 61    int display_tasks = (task_count > 4) ? 4 : task_count;
 62
 63    for (int t = 0; t < display_tasks; t++) {
 64        int row = 4 + t;
 65
 66        // 履歴を描画
 67        for (int i = 0; i < TASK_HISTORY_LEN; i++) {
 68            int hist_idx = (task_history_index + i + 1) % TASK_HISTORY_LEN;
 69            int col = i;
 70
 71            if (task_history[t][hist_idx] == t) {
 72                // このタスクが実行中だった
 73                frame[row][col] = 1;
 74            } else {
 75                frame[row][col] = 0;
 76            }
 77        }
 78
 79        // 現在の状態を示すインジケータ(右端)
 80        TaskState state = os_get_task_state(t);
 81        switch (state) {
 82            case TASK_RUNNING:
 83                frame[row][10] = 1;
 84                frame[row][11] = 1;
 85                break;
 86            case TASK_READY:
 87                frame[row][10] = 1;
 88                frame[row][11] = 0;
 89                break;
 90            case TASK_BLOCKED:
 91                frame[row][10] = 0;
 92                frame[row][11] = 1;
 93                break;
 94            default:
 95                frame[row][10] = 0;
 96                frame[row][11] = 0;
 97                break;
 98        }
 99    }
100}
101
102// 区切り線を描画
103static void draw_separator(void)
104{
105    // CPU負荷領域とタスク状態領域の間に区切り線
106    // 列8, 9を区切りとして使用
107    for (int row = 0; row < 8; row++) {
108        frame[row][8] = 0;
109        frame[row][9] = (row == 3) ? 1 : 0;  // 行3だけ点灯
110    }
111}
112
113void display_update(void)
114{
115    // CPU 使用率を更新(アイドル以外の割合)。
116    // os_get_cpu_usage() は呼ぶたびに基準時刻を更新するので、ここから呼ぶと
117    // シェルの ps の計測窓を壊してしまう。生カウンタから自前で差分を取る。
118    static uint32_t last_total = 0;
119    static uint32_t last_idle  = 0;
120
121    uint32_t total = os_get_tick();
122    uint32_t idle  = os_get_task_cpu_ticks(0);
123    uint32_t d_total = total - last_total;
124    uint32_t d_idle  = idle  - last_idle;
125    last_total = total;
126    last_idle  = idle;
127
128    int total_cpu = (d_total == 0) ? 0
129                  : (int)(100u - (d_idle * 100u) / d_total);
130
131    // 履歴に追加
132    cpu_history[history_index] = total_cpu;
133    history_index = (history_index + 1) % 12;
134
135    // 現在実行中のタスクを記録
136    int current = os_get_current_task();
137    if (current >= 0 && current < MAX_TASKS) {
138        task_history[current][task_history_index] = current;
139    }
140    task_history_index = (task_history_index + 1) % TASK_HISTORY_LEN;
141
142    // フレームバッファをクリア
143    memset(frame, 0, sizeof(frame));
144
145    // 各要素を描画
146    draw_cpu_graph();
147    draw_task_status();
148
149    // マトリクスに表示
150    matrix.renderBitmap(frame, 8, 12);
151}
152
153// 表示更新タスク
154void display_task(void)
155{
156    display_init();
157
158    while (1) {
159        display_update();
160        os_sleep(100);  // 100msごとに更新
161    }
162}
src/os_fault.cpp — 170 行

GitHub で開く

  1/**
  2 * os_fault.cpp - Fault Handler Implementation
  3 * Chapter 6: Memory Protection
  4 */
  5
  6#include "os_fault.h"
  7#include "os_kernel.h"
  8#include <Arduino.h>
  9
 10static volatile int g_fault_occurred = 0;
 11static volatile const char* g_fault_reason = "";
 12static volatile int g_faulted_task = -1;
 13
 14// Forward declarations for vector table override
 15extern "C" __attribute__((naked)) void HardFault_Handler(void);
 16extern "C" void PendSV_Handler(void);
 17extern "C" void SysTick_Handler(void);
 18
 19void fault_init(void)
 20{
 21    // Enable divide by zero trap
 22    SCB->CCR |= SCB_CCR_DIV_0_TRP_Msk;
 23
 24    // Do NOT enable separate UsageFault/BusFault/MemFault handlers.
 25    // By leaving them disabled, all faults escalate to HardFault,
 26    // which we handle via the VTOR override above.
 27
 28    // The Arduino framework copies the vector table to RAM (VTOR points to RAM).
 29    // We must overwrite the HardFault entry in the RAM vector table directly.
 30    // Also override PendSV and SysTick entries for the OS scheduler.
 31    uint32_t *vtor = (uint32_t *)SCB->VTOR;
 32    vtor[3] = (uint32_t)HardFault_Handler;   // Vector #3 = HardFault
 33    vtor[14] = (uint32_t)PendSV_Handler;     // Vector #14 = PendSV
 34    vtor[15] = (uint32_t)SysTick_Handler;    // Vector #15 = SysTick
 35
 36    g_fault_occurred = 0;
 37    g_fault_reason = "";
 38}
 39
 40const char* fault_get_reason(void)
 41{
 42    return (const char*)g_fault_reason;
 43}
 44
 45int fault_occurred(void)
 46{
 47    return g_fault_occurred;
 48}
 49
 50void fault_clear(void)
 51{
 52    g_fault_occurred = 0;
 53    g_fault_reason = "";
 54}
 55
 56static void analyze_fault(void)
 57{
 58    uint32_t cfsr = SCB->CFSR;
 59
 60    // Check Usage Fault Status Register (UFSR)
 61    if (cfsr & SCB_CFSR_DIVBYZERO_Msk) {
 62        g_fault_reason = "Divide by zero";
 63    } else if (cfsr & SCB_CFSR_UNALIGNED_Msk) {
 64        g_fault_reason = "Unaligned access";
 65    } else if (cfsr & SCB_CFSR_UNDEFINSTR_Msk) {
 66        g_fault_reason = "Undefined instruction";
 67    } else if (cfsr & SCB_CFSR_INVSTATE_Msk) {
 68        g_fault_reason = "Invalid state (Thumb bit)";
 69    } else if (cfsr & SCB_CFSR_INVPC_Msk) {
 70        g_fault_reason = "Invalid PC";
 71    }
 72    // Check Bus Fault Status Register (BFSR)
 73    else if (cfsr & SCB_CFSR_PRECISERR_Msk) {
 74        g_fault_reason = "Precise data bus error";
 75    } else if (cfsr & SCB_CFSR_IMPRECISERR_Msk) {
 76        g_fault_reason = "Imprecise data bus error";
 77    } else if (cfsr & SCB_CFSR_IBUSERR_Msk) {
 78        g_fault_reason = "Instruction bus error";
 79    }
 80    // Check Memory Management Fault Status Register (MMFSR)
 81    else if (cfsr & SCB_CFSR_DACCVIOL_Msk) {
 82        g_fault_reason = "Data access violation";
 83    } else if (cfsr & SCB_CFSR_IACCVIOL_Msk) {
 84        g_fault_reason = "Instruction access violation";
 85    }
 86    else {
 87        g_fault_reason = "Unknown fault";
 88    }
 89
 90    // Clear fault flags
 91    SCB->CFSR = cfsr;
 92}
 93
 94// Safe landing pad for terminated tasks after fault recovery
 95extern "C" void _fault_task_sink(void)
 96{
 97    while (1) {
 98        __WFI();
 99    }
100}
101
102// Flag to defer fault message printing to a safe context
103static volatile int g_fault_pending_print = 0;
104static volatile uint32_t g_fault_pc = 0;
105
106extern "C" void HardFault_Handler_C(FaultFrame *frame)
107{
108    g_fault_occurred = 1;
109    g_faulted_task = g_current_task;
110    g_fault_pc = frame->pc;
111
112    analyze_fault();
113
114    // Terminate the faulted task and redirect PC to safe sink
115    if (g_faulted_task > 0) {
116        os_terminate_task(g_faulted_task);
117
118        // Rewrite the stacked PC to a safe infinite loop so that
119        // returning from the fault doesn't re-execute the faulting
120        // instruction. The SysTick scheduler will switch away from
121        // this terminated task on the next tick.
122        frame->pc = (uint32_t)_fault_task_sink;
123        frame->xpsr = 0x01000000;  // Thumb bit set
124
125        // Defer printing to next safe context
126        g_fault_pending_print = 1;
127        return;
128    }
129
130    // If idle task or no task crashed, halt
131    while (1) { }
132}
133
134// Call this from a task (e.g., shell) to print deferred fault info
135void fault_print_pending(void)
136{
137    if (!g_fault_pending_print) return;
138    g_fault_pending_print = 0;
139
140    Serial.println();
141    Serial.println("!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!");
142    Serial.println("!!!       FAULT DETECTED      !!!");
143    Serial.println("!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!");
144    Serial.println();
145    Serial.print("Task ");
146    Serial.print(g_faulted_task);
147    Serial.print(" (");
148    Serial.print(os_get_task_name(g_faulted_task));
149    Serial.println(") crashed!");
150    Serial.print("Reason: ");
151    Serial.println((const char*)g_fault_reason);
152    Serial.print("PC at fault: 0x");
153    Serial.println(g_fault_pc, HEX);
154    Serial.println("Task terminated. Other tasks continue.");
155    Serial.println();
156}
157
158extern "C" __attribute__((naked)) void HardFault_Handler(void)
159{
160    __asm volatile (
161        "   TST     LR, #4              \n"  // Check which stack was used
162        "   ITE     EQ                  \n"
163        "   MRSEQ   R0, MSP             \n"  // MSP if LR bit 2 is 0
164        "   MRSNE   R0, PSP             \n"  // PSP if LR bit 2 is 1
165        "   PUSH    {LR}                \n"  // Save EXC_RETURN
166        "   BL      HardFault_Handler_C \n"  // Call C handler (preserves LR on stack)
167        "   POP     {LR}                \n"  // Restore EXC_RETURN
168        "   BX      LR                  \n"  // Return from exception properly
169    );
170}
src/os_kernel.cpp — 241 行

GitHub で開く

  1/**
  2 * os_kernel.cpp - Mini OS Kernel Implementation
  3 * Chapter 6: Memory Protection
  4 */
  5
  6#include "os_kernel.h"
  7#include <Arduino.h>
  8#include <string.h>
  9
 10TCB g_tasks[MAX_TASKS];
 11volatile int g_task_count = 0;
 12volatile int g_current_task = -1;
 13volatile int g_next_task = -1;
 14volatile uint32_t g_system_ticks = 0;
 15
 16const uint32_t g_tcb_size = sizeof(TCB);
 17
 18static uint32_t g_stack_pool[STACK_POOL_SIZE / 4];
 19static uint32_t g_stack_used;   // 切り出し済みのワード数
 20
 21static void idle_task(void) { while (1) __WFI(); }
 22
 23// タスク関数が return したときの受け皿。例外フレームの LR スロットは
 24// ここを指す (第3章 3.4)。EXC_RETURN を置く場所ではない。
 25static void task_exit(void)
 26{
 27    g_tasks[g_current_task].state = TASK_TERMINATED;
 28    os_yield();
 29    while (1) { }  // ここには到達しない
 30}
 31
 32static uint32_t* init_task_stack(uint32_t *stack_top, void (*entry)(void))
 33{
 34    uint32_t *sp = stack_top;
 35    *(--sp) = 0x01000000;
 36    *(--sp) = (uint32_t)entry;
 37    *(--sp) = (uint32_t)task_exit;  // LR: タスクが return したときの戻り先
 38    *(--sp) = 0; *(--sp) = 0; *(--sp) = 0; *(--sp) = 0; *(--sp) = 0;
 39    // FPU を使ったタスクは例外フレームが拡張される(FP レジスタ込み)。
 40    // どちらのフレームで中断したかは EXC_RETURN の値に現れるため、
 41    // タスクごとに EXC_RETURN も保存する。初期値は「PSP・基本フレーム」。
 42    *(--sp) = 0xFFFFFFFD;
 43    *(--sp) = 0; *(--sp) = 0; *(--sp) = 0; *(--sp) = 0;
 44    *(--sp) = 0; *(--sp) = 0; *(--sp) = 0; *(--sp) = 0;
 45    return sp;
 46}
 47
 48void os_init(void)
 49{
 50    memset(g_tasks, 0, sizeof(g_tasks));
 51    g_task_count = 0;
 52    g_current_task = -1;
 53    g_next_task = -1;
 54    g_system_ticks = 0;
 55    os_create_task(idle_task, "idle", IDLE_STACK_SIZE);
 56}
 57
 58int os_create_task(void (*entry)(void), const char *name, uint32_t stack_size)
 59{
 60    if (g_task_count >= MAX_TASKS) return -1;
 61    int id = g_task_count;
 62    TCB *task = &g_tasks[id];
 63    task->id = id;
 64    task->state = TASK_READY;
 65    task->priority = id;
 66    task->entry = entry;
 67    task->wake_tick = 0;
 68    task->cpu_ticks = 0;
 69    strncpy(task->name, name, sizeof(task->name) - 1);
 70    if (stack_size == 0) {
 71        stack_size = DEFAULT_STACK_SIZE;
 72    }
 73    uint32_t words = (stack_size + 3) / 4;
 74    if (g_stack_used + words > STACK_POOL_SIZE / 4) {
 75        return -1;          // プールが尽きた。黙って縮めず、失敗として返す
 76    }
 77    g_stack_used += words;
 78    task->stack_size = stack_size;
 79    task->stack_base = &g_stack_pool[g_stack_used];   // スタックは上端から下へ伸びる
 80    task->sp = init_task_stack(task->stack_base, entry);
 81    g_task_count++;
 82    return id;
 83}
 84
 85void os_schedule(void)
 86{
 87    for (int i = 0; i < g_task_count; i++) {
 88        if (g_tasks[i].state == TASK_BLOCKED && g_system_ticks >= g_tasks[i].wake_tick) {
 89            g_tasks[i].state = TASK_READY;
 90        }
 91    }
 92
 93    int next = g_current_task;
 94    do {
 95        next = (next + 1) % g_task_count;
 96        if (g_tasks[next].state == TASK_READY || g_tasks[next].state == TASK_RUNNING) break;
 97    } while (next != g_current_task);
 98
 99    if (next != g_current_task || g_current_task < 0) {
100        if (g_current_task >= 0 && g_tasks[g_current_task].state == TASK_RUNNING) {
101            g_tasks[g_current_task].state = TASK_READY;
102        }
103        g_tasks[next].state = TASK_RUNNING;
104        g_next_task = next;
105        SCB->ICSR |= SCB_ICSR_PENDSVSET_Msk;
106    }
107}
108
109void os_yield(void) { os_schedule(); }
110void os_sleep(uint32_t ms) {
111    if (g_current_task > 0) {
112        g_tasks[g_current_task].state = TASK_BLOCKED;
113        g_tasks[g_current_task].wake_tick = g_system_ticks + ms;
114        os_schedule();
115    }
116}
117void os_suspend_task(int id) {
118    if (id > 0 && id < g_task_count) {
119        g_tasks[id].state = TASK_SUSPENDED;
120        if (id == g_current_task) os_schedule();
121    }
122}
123void os_resume_task(int id) {
124    if (id > 0 && id < g_task_count && g_tasks[id].state == TASK_SUSPENDED) {
125        g_tasks[id].state = TASK_READY;
126    }
127}
128void os_terminate_task(int id) {
129    if (id > 0 && id < g_task_count) {
130        g_tasks[id].state = TASK_TERMINATED;
131        if (id == g_current_task) os_schedule();
132    }
133}
134
135uint32_t os_get_tick(void) { return g_system_ticks; }
136int os_get_task_count(void) { return g_task_count; }
137const char* os_get_task_name(int id) { return (id >= 0 && id < g_task_count) ? g_tasks[id].name : ""; }
138TaskState os_get_task_state(int id) { return (id >= 0 && id < g_task_count) ? g_tasks[id].state : TASK_TERMINATED; }
139int os_get_current_task(void) { return g_current_task; }
140
141void os_start(void)
142{
143    NVIC_SetPriority(PendSV_IRQn, 0xFF);
144    SysTick_Config(SystemCoreClock / 1000 * TIME_SLICE_MS);
145    g_current_task = -1;
146    g_next_task = 0;
147    // Do NOT switch CONTROL to PSP here — PSP is not yet initialized.
148    // PendSV returns with EXC_RETURN=0xFFFFFFFD, which automatically
149    // switches thread mode to PSP after loading the first task's context.
150    SCB->ICSR |= SCB_ICSR_PENDSVSET_Msk;
151    while (1) { }
152}
153
154extern "C" void SysTick_Handler(void) {
155    // 実際に経過した時間を、いま走っていたタスクの取り分として計上する。
156    // os_schedule() 側で数えると os_yield() の回数まで混ざってしまう。
157    if (g_current_task >= 0) {
158        g_tasks[g_current_task].cpu_ticks += TIME_SLICE_MS;
159    }
160    g_system_ticks += TIME_SLICE_MS;
161    os_schedule();
162}
163
164extern "C" __attribute__((naked)) void PendSV_Handler(void)
165{
166    __asm volatile (
167        "   MRS     R0, PSP              \n"
168        "   LDR     R1, =g_current_task  \n"
169        "   LDR     R2, [R1]             \n"
170        "   CMP     R2, #0               \n"
171        "   BLT     _skip_save           \n"
172        // FPU を使って中断したタスク(EXC_RETURN の bit4 が 0)は、
173        // ハードウェアが積まない S16-S31 もここで退避する
174        "   TST     LR, #0x10            \n"
175        "   IT      EQ                   \n"
176        "   VSTMDBEQ R0!, {S16-S31}      \n"
177        // R4-R11 と EXC_RETURN(LR) を保存する
178        "   STMDB   R0!, {R4-R11, LR}    \n"
179        "   LDR     R3, =g_tasks         \n"
180        "   LDR     R4, =g_tcb_size      \n"
181        "   LDR     R4, [R4]             \n"
182        "   MUL     R2, R2, R4           \n"
183        "   ADD     R3, R3, R2           \n"
184        "   STR     R0, [R3]             \n"
185        "_skip_save:                     \n"
186        "   LDR     R1, =g_next_task     \n"
187        "   LDR     R2, [R1]             \n"
188        "   LDR     R1, =g_current_task  \n"
189        "   STR     R2, [R1]             \n"
190        "   LDR     R3, =g_tasks         \n"
191        "   LDR     R4, =g_tcb_size      \n"
192        "   LDR     R4, [R4]             \n"
193        "   MUL     R2, R2, R4           \n"
194        "   ADD     R3, R3, R2           \n"
195        "   LDR     R0, [R3]             \n"
196        "   LDMIA   R0!, {R4-R11, LR}    \n"
197        // FPU を使って中断していたタスクなら S16-S31 も復元する
198        "   TST     LR, #0x10            \n"
199        "   IT      EQ                   \n"
200        "   VLDMIAEQ R0!, {S16-S31}      \n"
201        "   MSR     PSP, R0              \n"
202        "   BX      LR                   \n"
203    );
204}
205
206// CPU使用率を取得(パーセント)
207// 直前にこの関数を呼んだ時点からの差分で計算する。
208// ps のようにタスクごとにループで呼ぶため、基準時刻もタスクごとに持つ。
209// CPU 使用カウンタの生値。os_get_cpu_usage() と違って状態を持たないので、
210// 何度呼んでも他の呼び手の計測窓を壊さない (第4章 4.7)。
211uint32_t os_get_task_cpu_ticks(int task_id)
212{
213    if (task_id < 0 || task_id >= g_task_count) {
214        return 0;
215    }
216    return g_tasks[task_id].cpu_ticks;
217}
218
219int os_get_cpu_usage(int task_id)
220{
221    if (task_id < 0 || task_id >= g_task_count) {
222        return -1;
223    }
224
225    static uint32_t last_total[MAX_TASKS] = {0};
226    static uint32_t last_task_ticks[MAX_TASKS] = {0};
227
228    uint32_t total = g_system_ticks;
229    uint32_t delta_total = total - last_total[task_id];
230
231    if (delta_total == 0) {
232        return 0;
233    }
234
235    uint32_t delta_task = g_tasks[task_id].cpu_ticks - last_task_ticks[task_id];
236
237    last_total[task_id] = total;
238    last_task_ticks[task_id] = g_tasks[task_id].cpu_ticks;
239
240    return (delta_task * 100) / delta_total;
241}
src/shell.cpp — 190 行

GitHub で開く

  1/**
  2 * shell.cpp - Interactive Shell Implementation
  3 * Chapter 5: Interactive Shell
  4 */
  5
  6#include "shell.h"
  7#include "os_kernel.h"
  8#include "os_fault.h"
  9#include <Arduino.h>
 10#include <string.h>
 11
 12#define CMD_BUF_SIZE 64
 13
 14static char cmd_buf[CMD_BUF_SIZE];
 15static int cmd_pos = 0;
 16
 17static const char* state_to_str(TaskState state)
 18{
 19    switch (state) {
 20        case TASK_READY:      return "READY";
 21        case TASK_RUNNING:    return "RUNNING";
 22        case TASK_BLOCKED:    return "BLOCKED";
 23        case TASK_SUSPENDED:  return "SUSPEND";
 24        case TASK_TERMINATED: return "TERM";
 25        default:              return "?";
 26    }
 27}
 28
 29static void cmd_help(void)
 30{
 31    Serial.println("Available commands:");
 32    Serial.println("  ps      - List all tasks");
 33    Serial.println("  kill N  - Suspend task N");
 34    Serial.println("  exec N  - Resume task N");
 35    Serial.println("  info    - System information");
 36    Serial.println("  reboot  - Reboot system");
 37    Serial.println("  help    - Show this help");
 38}
 39
 40static void cmd_ps(void)
 41{
 42    Serial.println();
 43    Serial.println("ID  NAME           STATE      CPU%");
 44    Serial.println("--  ----           -----      ----");
 45
 46    for (int i = 0; i < os_get_task_count(); i++) {
 47        Serial.print(i);
 48        Serial.print("   ");
 49
 50        const char *name = os_get_task_name(i);
 51        Serial.print(name);
 52        for (int j = strlen(name); j < 15; j++) Serial.print(" ");
 53
 54        Serial.print(state_to_str(os_get_task_state(i)));
 55        for (int j = strlen(state_to_str(os_get_task_state(i))); j < 10; j++) Serial.print(" ");
 56
 57        Serial.print(os_get_cpu_usage(i));
 58        Serial.println("%");
 59    }
 60    Serial.println();
 61}
 62
 63static void cmd_kill(int id)
 64{
 65    if (id <= 0) {
 66        Serial.println("Error: Cannot kill idle task (ID 0)");
 67        return;
 68    }
 69    if (id >= os_get_task_count()) {
 70        Serial.println("Error: Invalid task ID");
 71        return;
 72    }
 73
 74    os_suspend_task(id);
 75    Serial.print("Task ");
 76    Serial.print(id);
 77    Serial.print(" (");
 78    Serial.print(os_get_task_name(id));
 79    Serial.println(") suspended.");
 80}
 81
 82static void cmd_exec(int id)
 83{
 84    if (id <= 0 || id >= os_get_task_count()) {
 85        Serial.println("Error: Invalid task ID");
 86        return;
 87    }
 88
 89    os_resume_task(id);
 90    Serial.print("Task ");
 91    Serial.print(id);
 92    Serial.print(" (");
 93    Serial.print(os_get_task_name(id));
 94    Serial.println(") resumed.");
 95}
 96
 97static void cmd_info(void)
 98{
 99    Serial.println();
100    Serial.println("=== System Information ===");
101    Serial.print("System Ticks:  ");
102    Serial.println(os_get_tick());
103    Serial.print("Uptime:        ");
104    Serial.print(os_get_tick() / 1000);
105    Serial.println(" s");
106    Serial.print("Task Count:    ");
107    Serial.println(os_get_task_count());
108    Serial.print("Time Slice:    ");
109    Serial.print(TIME_SLICE_MS);
110    Serial.println(" ms");
111    Serial.println();
112}
113
114static void cmd_reboot(void)
115{
116    Serial.println("Rebooting...");
117    delay(100);
118    NVIC_SystemReset();
119}
120
121void shell_process_command(char *cmd)
122{
123    // Trim whitespace
124    while (*cmd == ' ') cmd++;
125    char *end = cmd + strlen(cmd) - 1;
126    while (end > cmd && *end == ' ') *end-- = '\0';
127
128    if (strlen(cmd) == 0) return;
129
130    // Parse command
131    if (strcmp(cmd, "help") == 0 || strcmp(cmd, "?") == 0) {
132        cmd_help();
133    } else if (strcmp(cmd, "ps") == 0) {
134        cmd_ps();
135    } else if (strncmp(cmd, "kill ", 5) == 0) {
136        int id = atoi(cmd + 5);
137        cmd_kill(id);
138    } else if (strncmp(cmd, "exec ", 5) == 0) {
139        int id = atoi(cmd + 5);
140        cmd_exec(id);
141    } else if (strcmp(cmd, "info") == 0) {
142        cmd_info();
143    } else if (strcmp(cmd, "reboot") == 0) {
144        cmd_reboot();
145    } else {
146        Serial.print("Unknown command: ");
147        Serial.println(cmd);
148        Serial.println("Type 'help' for available commands.");
149    }
150}
151
152void shell_task(void)
153{
154    Serial.println();
155    Serial.println("Mini OS Shell");
156    Serial.println("Type 'help' for commands.");
157
158    while (1) {
159        // 保留中のフォルト情報をタスク文脈で表示する (第6章 6.3)
160        fault_print_pending();
161
162        Serial.print("> ");
163
164        cmd_pos = 0;
165        memset(cmd_buf, 0, CMD_BUF_SIZE);
166
167        while (1) {
168            if (Serial.available()) {
169                char ch = Serial.read();
170
171                if (ch == '\r' || ch == '\n') {
172                    Serial.println();
173                    break;
174                } else if (ch == '\b' || ch == 127) {
175                    if (cmd_pos > 0) {
176                        cmd_pos--;
177                        cmd_buf[cmd_pos] = '\0';
178                        Serial.print("\b \b");
179                    }
180                } else if (cmd_pos < CMD_BUF_SIZE - 1) {
181                    cmd_buf[cmd_pos++] = ch;
182                    Serial.print(ch);
183                }
184            }
185            os_sleep(10);
186        }
187
188        shell_process_command(cmd_buf);
189    }
190}

実機での出力#

Arduino UNO R4 WiFi の実機で実際に取得した出力です(macOS / Windows の 両方で同じ結果を確認しています)。手元の出力と見比べてください。

ps

ID  NAME           STATE      CPU%
--  ----           -----      ----
0   idle           READY     50%
1   LED            BLOCKED   0%
2   Light          BLOCKED   0%
3   Heavy          READY     49%
4   Shell          RUNNING   0%
5   Display        READY     0%

> 

Heavy は眠らないのに 49% しかありません。本書のスケジューラは idle(ID 0)も普通の タスクと同じ順番で回すので、ほかのタスクが眠っている間は idle と Heavy が交互に走り、 CPU を半分ずつ分け合うためです。

実機のマトリクスはこう動きます。

../_images/ch07_kill.gif

実機の LED マトリクス。上半分が直近 1.2 秒の CPU 負荷で、0.1 秒ごとに左から順に 1 列ずつ書き換わります。下半分の右端 2 列はタスク 0〜3 の状態です。kill 3 で Heavy を止めるとグラフが下がり、exec 3 でまた上がります。(UNO R4 WiFi を Web カメラで撮影)#

シミュレータで見る#

実機が無くても、同じファームウェアを シミュレータ で動かすとこう見えます。

../_images/sim_ch07_kill.gif

マトリクスの上半分が直近 1.2 秒の CPU 負荷(0.1 秒ごとに左から順に 1 列ずつ書き換わる)、下半分の右端 2 列がタスク 0〜3 の状態です。kill 3 で重い計算の Heavy を止めるとグラフが消えていき、exec 3 でまた上がります。(シミュレータで撮影)#

改良版: 07_led_matrix_v2(書籍未掲載)#

本書のコードの表示は、上半分の負荷の履歴が時間の順に並んでいないことと、 下半分がほとんど光らないことから、何を表しているのか読み取りにくいところが あります。そこで表示を Linux の htop(CPU の負荷を横棒で、プロセスごとの CPU 使用率を一覧で出すツール。下のコラム参照)のような「いまの値」の横棒に した改良版を code/07_led_matrix_v2 に置きました。カーネルは本書と同じで、 変えたのは表示・シェル・タスクの中身だけです。

書籍のリポジトリ(learning-os-from-arduino)には入っていないので、このサイトの リポジトリから取ってきて書き込みます。

git clone https://github.com/iory/build-your-own-arduino-rtos.git
cd build-your-own-arduino-rtos/code
uv sync
uv run pio run -d 07_led_matrix_v2 -t upload
uv run pio device monitor -b 115200

行

中身(どれも 12 個で 100%、0.5 秒ごとに更新)

0–1

CPU 全体の負荷(idle 以外)

2

空き

3–7

LED / Light / Heavy / Shell / Display の CPU 使用率

シェルに足した top と打つと、マトリクスと同じ数字が 0.5 秒ごとに端末へ 描き直されます(もう一度 top で止まる。表示中も kill 3 などを打てます)。 Heavy 以外に Light も CPU を使うようにしてあるので、行ごとの棒を足すと CPU 全体の棒になるのが見えます。

実機(UNO R4 WiFi)の top の値は次のとおりです。

操作

CPU 全体

目に見えること

起動直後

約 60%

Light(16%)と Heavy(40%)の行に棒

kill 3

約 24%

Heavy の棒が消え、全体の棒が縮む

kill 2

約 4%

残るのは top を描いている Shell だけ

exec 2 / exec 3

元に戻る

注釈

Heavy は眠らずに回り続けても 40〜50% しか取れません。本書のスケジューラは idle も普通のタスクと同じ順番で回すので、idle と CPU を分け合うためです。

コラム: top と htop

Linux には、動いているプロセスごとの CPU 使用率を一覧する top(procps-ng)と、 それを見やすくした htop があります。v2 のマトリクスとシェルの top は、 この 2 つを真似たものです。

見ているもの。 htop の画面上部の CPU メーターは、CPU 時間を種類 (nice・user・system など)ごとに色分けして積み上げた横棒です (htop(1) の METERS)。その下の一覧の %CPU は、 「前回画面を描いてから今回までの経過時間のうち、そのプロセスが使った割合」です (top(1) の %CPU)。v2 では行 0–1 が CPU メーター、行 3–7 が一覧に あたります。

更新の間隔。 htop は既定で 1.5 秒ごとに描き直します(-d は 0.1 秒単位で、 既定値は 15。Settings.h)。procps-ng の top も既定は 1.5 秒で、 元の設定でビルドした場合は 3 秒です(top.h)。v2 は 0.5 秒です。

CPU 時間の数え方。 Linux は基本的に、タイマ割り込み(tick)のたびに 「そのとき走っていたタスク」へ 1 tick ぶんの CPU 時間を足していきます (account_process_tick())。その合計が /proc/stat (proc_stat(5))などに出ていて、top は 2 回読んだ差分から 割合を出します。本書の OS も、SysTick 割り込みのたびに走っていたタスクへ 10 ms を足していて(os_kernel.cpp の SysTick_Handler)、考え方は同じです。 v2 はこの値を 0.5 秒ごとに 2 回読んで差を取っています。

tick で数える方式は、tick と tick の間に終わってしまう短い仕事を取りこぼします。 LED タスクが 0% に見えるのはこのためです(Linux でも、設定によっては tick 以外の 方法で数えます)。

止める。 top では k、htop では F9 か k で、選んだプロセスにシグナルを 送って止めます(top(1)、htop(1))。本書のシェルの kill N はタスクを一時停止(suspend)するだけなので、exec N で再開できます。

壊してみる#

ここでは、上の改良版 07_led_matrix_v2 を使います。カーネルは本書のコードと同じで、 マトリクスの横棒と top で CPU% の変化が目で見えるからです。

予想してから答えを開いてください。1 つめはコードを変えずに、 ブラウザ版の改良版で そのまま試せます。2 つめはコードを変えてビルドし、firmware.elf を ブラウザ版にドロップ します。v2 はこのサイトの リポジトリにあるので、上の「改良版」の手順で clone した code/ の中で作業します。

uv run pio run -d 07_led_matrix_v2
# できた 07_led_matrix_v2/.pio/build/uno_r4_wifi/firmware.elf をブラウザ版にドロップ
# 元に戻すとき: git checkout -- 07_led_matrix_v2

注釈

答えに載せた出力は、ブラウザ版と同じ QEMU で実際に動かして取ったものです。 実機ではまだ確かめていません。ブラウザ版は重い計算が実機より遅いので、 CPU% の値は少し違って見えることがあります。

1. シェルが自分を止める#

kill 0 は Error: Cannot kill idle task (ID 0) で断られます。 では、kill 4 はどうでしょう。ID 4 は、いまコマンドを受け付けているシェル自身です。

予想: kill 4 のあと、exec 4 で元に戻せるでしょうか。

答え

戻せません。 kill 4 を打つと、いつもの Task 4 (Shell) suspended. すら出ずに、 それきり ps も exec 4 も top も、何を打っても返事がありません。

Mini OS Shell
Type 'help' for commands.
> kill 4

os_suspend_task() は、止めるのが自分自身なら、その場で os_schedule() を呼んで ほかのタスクに切り替えます。シェルは suspended. を表示する前に止まり、二度と 順番が回ってきません。exec 4 を打っても、それを読むはずのシェルが止まっているので 届きません。

戻すにはリセットします(ブラウザ版ならページを読み込み直します)。 kill 0 と同じように、kill が自分自身の ID を断るようにすれば防げます。

2. idle を順番から外す#

ps を打つと、眠らずに回り続ける Heavy の CPU% が 41% しかありません (QEMU で idle 41%・Light 16%・Heavy 41%)。本書のスケジューラが、idle も普通の タスクと同じ順番で回していて、Heavy と idle が CPU を分け合うからです。

そこで、src/os_kernel.cpp の os_schedule() を変えて、idle はほかに走れるタスクが 無いときだけ選ぶようにします。

     int next = g_current_task;
     do {
         next = (next + 1) % g_task_count;
-        if (g_tasks[next].state == TASK_READY || g_tasks[next].state == TASK_RUNNING) break;
+        if (next != 0 && (g_tasks[next].state == TASK_READY || g_tasks[next].state == TASK_RUNNING)) break;
     } while (next != g_current_task);
+    if (g_tasks[next].state != TASK_READY && g_tasks[next].state != TASK_RUNNING) next = 0;

予想: マトリクスの Heavy の行と、いちばん上の全体の棒はどうなるでしょう。

答え

全体の棒が 12 個いっぱいになり、Heavy の棒が倍近くに伸びます。 ps では Heavy が 79%、idle が 0% です(ブラウザ版では Heavy 76%)。

> ps

ID  NAME           STATE      CPU%
--  ----           -----      ----
0   idle           READY     0%
1   LED            BLOCKED   0%
2   Light          BLOCKED   20%
3   Heavy          READY     79%
4   Shell          RUNNING   0%
5   Display        BLOCKED   0%

全体の棒は「idle 以外」の割合なので、idle が 0% なら 100% です。 ほかのタスクが眠っている間、これまでは idle と Heavy が交互に走っていましたが、 いまは Heavy だけが走ります。Light が眠っている間の時間も Heavy が使うので、 Light の 20% を除いた残りが、ほぼ全部 Heavy に回ります。

ブラウザ版で top を出したままにすると、Heavy は 50% ほどに下がります。 遅いエミュレータの上で表を描き直すのに、Shell が 30% ほど使うからです。 Heavy の値を比べるときは、top を止めて ps で見てください。

続けて kill 3 で Heavy を止め、数秒待って ps を打つと、idle 74%・Light 25% に なりました。走れるタスクが無い時間だけ、idle が走っています。

LED が 0% なのは、仕事を 10 ms(1 tick)より短い時間で終えて眠るので、 tick のたびに数える方式では取りこぼすためです(コラム「top と htop」)。

つまずきやすいポイント#

(読者からの質問に応じて随時追記します。質問は GitHub Issues へどうぞ)