Dublin Core The Dublin Core metadata element set is common to all Omeka records, including items, files, and collections. For more information see, http://dublincore.org/documents/dces/. Title A name given to the resource note Description An account of the resource 日常のノート note 日常のノートの記録 note テキストの自由記述 <h1>ロボット工学 - 内界センサー（Internal Sensors）</h1> <h2>概要</h2> <p>ロボット制御システムの根幹を成す内界センサーについて、基礎理論から実装まで包括的に解説します。制御工学、信号処理、材料力学の知識を統合した実践的な内容となっています。</p> <h3>学習目標</h3> <p>この資料を読むことで、以下の知識を習得できます：</p> <ol> <li><strong>理論的理解</strong>: 各センサーの物理的原理と数学的モデル</li> <li><strong>実装技術</strong>: 実際のシステムでの統合方法と信号処理</li> <li><strong>設計指針</strong>: 用途に応じたセンサー選択とシステム設計</li> <li><strong>トラブルシューティング</strong>: よくある問題と解決策</li> <li><strong>最新動向</strong>: 現代のロボットシステムでの応用事例</li> </ol> <h3>対象読者</h3> <ul> <li>ロボット工学を学ぶ学生・大学院生</li> <li>産業用ロボットの設計・開発エンジニア</li> <li>制御システムの技術者</li> <li>センサー技術に興味のある研究者</li> </ul> <h2>目次</h2> <ol> <li><a href="#1-%E5%86%85%E7%95%8C%E3%82%BB%E3%83%B3%E3%82%B5%E3%83%BC%E3%81%AE%E5%AE%9A%E7%BE%A9%E3%81%A8%E5%88%86%E9%A1%9E">内界センサーの定義と分類</a></li> <li><a href="#2-%E5%89%9B%E4%BD%93%E3%81%AE%E9%81%8B%E5%8B%95%E5%AD%A6%E3%81%A8%E8%87%AA%E7%94%B1%E5%BA%A6">剛体の運動学と自由度</a></li> <li><a href="#3-%E3%82%A8%E3%83%B3%E3%82%B3%E3%83%BC%E3%83%80encoder">エンコーダ（Encoder）</a></li> <li><a href="#4-%E3%83%9D%E3%83%86%E3%83%B3%E3%82%B7%E3%83%A7%E3%83%A1%E3%83%BC%E3%82%BFpotentiometer">ポテンショメータ（Potentiometer）</a></li> <li><a href="#5-%E3%83%AC%E3%82%BE%E3%83%AB%E3%83%90resolver">レゾルバ（Resolver）</a></li> <li><a href="#6-%E3%82%BF%E3%82%B3%E3%82%B8%E3%82%A7%E3%83%8D%E3%83%AC%E3%83%BC%E3%82%BFtachogenerator">タコジェネレータ（Tachogenerator）</a></li> <li><a href="#7-%E5%8A%9B%E3%82%BB%E3%83%B3%E3%82%B5%E3%83%BCforce-sensors">力センサー（Force Sensors）</a></li> <li><a href="#8-%E9%AB%98%E5%BA%A6%E3%81%AA%E4%BF%A1%E5%8F%B7%E5%87%A6%E7%90%86%E6%8A%80%E8%A1%93">高度な信号処理技術</a></li> <li><a href="#9-%E3%81%BE%E3%81%A8%E3%82%81%E3%81%A8%E6%8A%80%E8%A1%93%E6%AF%94%E8%BC%83">まとめと技術比較</a></li> <li><a href="#%E5%8F%82%E8%80%83%E6%96%87%E7%8C%AE%E9%96%A2%E9%80%A3%E3%83%AA%E3%83%B3%E3%82%AF">参考文献・関連リンク</a></li> </ol> <h2>1. 内界センサーの定義と分類</h2> <h3>1.1 内界センサーとは</h3> <p><strong>内界センサー（Internal Sensors）</strong>は、ロボットシステム内部の状態変数を直接計測するセンサー群である。これらは制御ループ内でフィードバック信号を生成し、ロボットの運動制御、位置決め、力制御において重要な役割を果たす。</p> <h4>内界センサーの特徴</h4> <ol> <li><strong>直接測定</strong>: ロボット自身の物理量を直接検出</li> <li><strong>高精度</strong>: 制御に必要な精度を提供</li> <li><strong>高速応答</strong>: リアルタイム制御に対応</li> <li><strong>信頼性</strong>: 環境変化に比較的強い</li> </ol> <p><strong>重要ポイント</strong><br />内界センサーは「ロボット自身の状態」を測定するセンサーです。対照的に外界センサー（カメラ、レーザーなど）は「環境の状態」を測定します。</p> <h4>実用例：産業用ロボットアーム</h4> <pre>関節1: エンコーダ（位置検出）関節2: レゾルバ（高精度位置検出）関節3: ポテンショメータ（角度検出）エンドエフェクタ: 力センサー（接触力検出）モータ軸: タコジェネレータ（速度検出） </pre> <h3>1.2 センサー分類と制御系での位置づけ</h3> <pre>制御対象 → 内界センサー → 制御器 → アクチュエータ → 制御対象 ↑ ↓ └────────── フィードバックループ ──────────┘ </pre> <p><strong>制御ループの流れ：</strong></p> <ol> <li><strong>制御対象</strong>：ロボットの関節やエンドエフェクタ</li> <li><strong>内界センサー</strong>：位置・速度・力などを検出</li> <li><strong>制御器</strong>：PID制御などで目標値との差を計算</li> <li><strong>アクチュエータ</strong>：モータなどで実際の動作を実行</li> </ol> <h4>内界センサーの主要機能</h4> <ol> <li><strong>状態推定（State Estimation）</strong>：位置、速度、加速度の検出</li> <li><strong>外乱検出（Disturbance Detection）</strong>：負荷変動、摩擦変化の検出</li> <li><strong>制御精度向上（Control Accuracy Enhancement）</strong>：PID制御のフィードバック信号生成</li> <li><strong>安全性確保（Safety Assurance）</strong>：異常状態の早期検出</li> </ol> <h3>1.3 制御理論における位置づけ</h3> <p>内界センサーは以下の制御理論的概念と密接に関連する：</p> <ul> <li><strong>フィードバック制御</strong>：閉ループ制御系の安定性確保</li> <li><strong>状態空間表現</strong>：システムの状態変数として直接利用</li> <li><strong>オブザーバ理論</strong>：状態推定の精度向上</li> <li><strong>ロバスト制御</strong>：外乱に対する制御系の堅牢性</li> </ul> <h2>2. 剛体の運動学と自由度</h2> <h3>2.1 剛体の自由度（Degrees of Freedom）</h3> <p>3次元空間における剛体の自由度は6つである：</p> <p><strong>並進自由度（Translational DOF）</strong>：3つ</p> <ul> <li>x軸方向の並進</li> <li>y軸方向の並進</li> <li>z軸方向の並進</li> </ul> <p><strong>回転自由度（Rotational DOF）</strong>：3つ</p> <ul> <li>x軸周りの回転（ロール）</li> <li>y軸周りの回転（ピッチ）</li> <li>z軸周りの回転（ヨー）</li> </ul> <h3>2.2 位置・姿勢の数学的表現</h3> <h4>位置ベクトル</h4> <p>\[\mathbf{r} = [x, y, z]^T\]</p> <h4>回転行列</h4> <p>\[R = R_z(\gamma) \times R_y(\beta) \times R_x(\alpha)\]</p> <p>ここで：</p> <ul> <li>α：ロール角</li> <li>β：ピッチ角</li> <li>γ：ヨー角</li> </ul> <h4>角速度ベクトル</h4> <p>\[\mathbf{\omega} = [\omega_x, \omega_y, \omega_z]^T = \frac{d\mathbf{\Theta}}{dt} \quad [\text{rad/s}]\]</p> <h2>3. エンコーダ（Encoder）</h2> <h3>3.1 インクリメンタルエンコーダ（Incremental Encoder）</h3> <h4>動作原理</h4> <p>回転に伴ってパルス信号を出力し、パルス数をカウントすることで相対的な位置を検出する。</p> <h4>基本構成</h4> <ul> <li><strong>ディスク</strong>：等間隔のスリットが刻まれた円盤</li> <li><strong>発光素子</strong>：LEDまたはレーザーダイオード</li> <li><strong>受光素子</strong>：フォトトランジスタまたはフォトダイオード</li> <li><strong>信号処理回路</strong>：パルス整形、カウント回路</li> </ul> <h4>出力信号</h4> <ul> <li><strong>A相</strong>：基本パルス信号</li> <li><strong>B相</strong>：A相から90°位相がずれた信号</li> <li><strong>Z相</strong>：1回転ごとに1パルス出力（原点検出用）</li> </ul> <h3>3.2 位置・速度の計算</h3> <h4>位置計算</h4> <p>\[\theta(t) = \frac{2\pi}{N_0} \times N(t) \quad [\text{rad}]\]</p> <h4>速度計算</h4> <p>\[\omega(t) = \frac{d\theta}{dt} = \frac{2\pi}{N_0} \times \frac{dN}{dt} \quad [\text{rad/s}]\]</p> <p>ここで：</p> <ul> <li><strong>θ(t)</strong>：時刻tでの回転角度 [rad]</li> <li><strong>N(t)</strong>：時刻tでの累積パルス数</li> <li><strong>N₀</strong>：1回転あたりのパルス数（PPR: Pulses Per Revolution）</li> <li><strong>ω(t)</strong>：角速度 [rad/s]</li> </ul> <h4>分解能と精度</h4> <p>\[\text{分解能} = \frac{360°}{N_0} = \frac{2\pi}{N_0} \quad [\text{rad}]\]</p> <h4>4倍カウント方式</h4> <p>A相、B相の位相差を利用した4倍カウント：</p> <p>\[\text{実効分解能} = 4 \times N_0 \quad [\text{pulses/rev}]\]</p> <h4>技術仕様</h4> <ul> <li><strong>分解能</strong>：100～10,000 PPR</li> <li><strong>精度</strong>：±0.1°～±0.01°</li> <li><strong>応答周波数</strong>：100kHz～1MHz</li> <li><strong>回転速度</strong>：最大10,000 rpm</li> <li><strong>動作温度</strong>：-10°C～+70°C</li> <li><strong>振動耐性</strong>：10G（10～2000Hz）</li> </ul> <h4>制御系での利用</h4> <p>PID制御器での位置フィードバック信号として使用</p> <h4>実装例：サーボモータ制御</h4> <pre>// エンコーダ読み取り例（Arduino風） void readEncoder() { static int lastA = 0, lastB = 0; int currentA = digitalRead(ENCODER_A); int currentB = digitalRead(ENCODER_B); // エッジ検出 if (currentA != lastA) { if (currentA == currentB) { position++; // 正回転 } else { position--; // 逆回転 } } lastA = currentA; lastB = currentB; } </pre> <h4>トラブルシューティング</h4> <table> <tbody> <tr> </tr> <tr> <td>パルスが検出されない</td> <td>配線不良、電源不足</td> <td>配線確認、電圧測定</td> </tr> <tr> <td>位置がずれる</td> <td>ノイズ、電源変動</td> <td>シールド配線、安定化電源</td> </tr> <tr> <td>応答が遅い</td> <td>フィルタ設定</td> <td>カットオフ周波数調整</td> </tr> </tbody> </table> <h3>3.3 アブソリュートエンコーダ（Absolute Encoder）</h3> <h4>動作原理</h4> <p>各角度位置に対応した固有のデジタルコードを出力し、絶対的な位置を検出する。</p> <h4>分解能の計算</h4> <p>\[\text{分解能} = \frac{360°}{2^n} = \frac{2\pi}{2^n} \quad [\text{rad}]\]</p> <p>ここで：</p> <ul> <li><strong>n</strong>：ビット数</li> <li><strong>例</strong>：12ビットの場合、2^12 = 4,096パターン</li> <li><strong>分解能</strong> = 360° / 4,096 = 0.088°</li> </ul> <h4>グレイコード（Gray Code）</h4> <p>2進数ではなくグレイコードを使用する理由：</p> <pre>10進数 | 2進数 | グレイコード -------|-------|------------ 0 | 000 | 000 1 | 001 | 001 2 | 010 | 011 3 | 011 | 010 4 | 100 | 110 5 | 101 | 111 </pre> <p><strong>利点</strong>：</p> <ul> <li>隣接値間で1ビットのみ変化</li> <li>読み取り誤差の最小化</li> <li>デジタル回路の簡素化</li> </ul> <h4>技術仕様</h4> <ul> <li><strong>分解能</strong>：8～24ビット（0.14°～0.00002°）</li> <li><strong>精度</strong>：±0.01°～±0.001°</li> <li><strong>応答時間</strong>：1～10ms</li> <li><strong>インターフェース</strong>：SSI、BiSS、EtherCAT</li> <li><strong>動作温度</strong>：-40°C～+85°C</li> <li><strong>保護等級</strong>：IP65～IP67</li> </ul> <h4>インターフェース比較</h4> <table> <tbody> <tr> </tr> <tr> <td><strong>SSI</strong></td> <td>1MHz</td> <td>10m</td> <td>中</td> <td>低</td> </tr> <tr> <td><strong>BiSS</strong></td> <td>10MHz</td> <td>10m</td> <td>高</td> <td>中</td> </tr> <tr> <td><strong>EtherCAT</strong></td> <td>100Mbps</td> <td>100m</td> <td>高</td> <td>高</td> </tr> </tbody> </table> <h4>実装例：SSI通信</h4> <pre>// SSI読み取り例 uint32_t readSSI() { uint32_t data = 0; // クロック信号生成 for (int i = 0; i < 24; i++) { digitalWrite(CLK_PIN, HIGH); delayMicroseconds(1); if (digitalRead(DATA_PIN)) { data |= (1 << (23 - i)); } digitalWrite(CLK_PIN, LOW); delayMicroseconds(1); } return data; } </pre> <h3>3.4 エンコーダの信号処理</h3> <h4>デジタルフィルタリング</h4> <p><strong>移動平均フィルタ</strong></p> <p>\[H(z) = \frac{1 + z^{-1}}{2}\]</p> <p><strong>ローパスフィルタ</strong></p> <p>\[H(z) = \frac{1-\alpha}{1-\alpha z^{-1}}\]</p> <p>ここで \(\alpha = e^{-2\pi f_c/f_s}\)、\(f_c\): カットオフ周波数、\(f_s\): サンプリング周波数</p> <h4>速度推定アルゴリズム</h4> <p><strong>差分法</strong></p> <p>\[\omega[k] = \frac{\theta[k] - \theta[k-1]}{\Delta t}\]</p> <p><strong>高次差分法（ノイズ低減）</strong></p> <p>\[\omega[k] = \frac{\theta[k+1] - \theta[k-1]}{2\Delta t}\]</p> <p><strong>オブザーバ法</strong></p> <p>\[\hat{\mathbf{x}}[k+1] = A\hat{\mathbf{x}}[k] + B\mathbf{u}[k] + L(\mathbf{y}[k] - C\hat{\mathbf{x}}[k])\]</p> <h4>カルマンフィルタによる状態推定</h4> <p><strong>状態空間モデル</strong></p> <p>\[\mathbf{x}[k+1] = A\mathbf{x}[k] + B\mathbf{u}[k] + \mathbf{w}[k]\]</p> <p>\[\mathbf{y}[k] = C\mathbf{x}[k] + \mathbf{v}[k]\]</p> <p><strong>カルマンフィルタ方程式</strong></p> <p>予測ステップ：</p> <p>\[\hat{\mathbf{x}}[k|k-1] = A\hat{\mathbf{x}}[k-1|k-1] + B\mathbf{u}[k-1]\]</p> <p>\[P[k|k-1] = AP[k-1|k-1]A^T + Q\]</p> <p>更新ステップ：</p> <p>\[K[k] = P[k|k-1]C^T(CP[k|k-1]C^T + R)^{-1}\]</p> <p>\[\hat{\mathbf{x}}[k|k] = \hat{\mathbf{x}}[k|k-1] + K[k](\mathbf{y}[k] - C\hat{\mathbf{x}}[k|k-1])\]</p> <p>\[P[k|k] = (I - K[k]C)P[k|k-1]\]</p> <h4>実装例：位置・速度推定</h4> <pre>// カルマンフィルタ実装例 typedef struct { float x[2]; // [位置, 速度] float P[2][2]; // 誤差共分散行列 float Q[2][2]; // プロセスノイズ共分散 float R; // 観測ノイズ分散 } KalmanFilter; void kalman_predict(KalmanFilter* kf, float dt) { // 状態遷移行列 float A[2][2] = {{1, dt}, {0, 1}}; // 予測ステップ float x_pred[2] = {A[0][0]*kf->x[0] + A[0][1]*kf->x[1], A[1][0]*kf->x[0] + A[1][1]*kf->x[1]}; // 誤差共分散の更新 // P = A*P*A^T + Q // (実装省略) kf->x[0] = x_pred[0]; kf->x[1] = x_pred[1]; } void kalman_update(KalmanFilter* kf, float measurement) { // カルマンゲイン計算 float S = kf->P[0][0] + kf->R; float K = kf->P[0][0] / S; // 状態更新 float innovation = measurement - kf->x[0]; kf->x[0] += K * innovation; kf->x[1] += K * innovation; // 速度も更新 // 誤差共分散更新 kf->P[0][0] *= (1 - K); kf->P[0][1] *= (1 - K); kf->P[1][0] *= (1 - K); kf->P[1][1] *= (1 - K); } </pre> <h2>4. ポテンショメータ（Potentiometer）</h2> <h3>4.1 動作原理</h3> <p>ポテンショメータは、抵抗体の分圧比を利用して角度を電圧に変換するセンサーである。</p> <h4>基本構成</h4> <ul> <li><strong>抵抗体</strong>：炭素皮膜、金属皮膜、ワイヤー巻き</li> <li><strong>可動接点</strong>：回転軸に連動するスライダー</li> <li><strong>固定端子</strong>：電源入力、グランド、出力</li> </ul> <h4>電圧出力特性</h4> <p>\[V_{\text{out}} = V_{\text{supply}} \times \frac{\theta}{\theta_{\max}}\]</p> <p>ここで：</p> <ul> <li><strong>V_out</strong>：出力電圧 [V]</li> <li><strong>V_supply</strong>：供給電圧 [V]</li> <li><strong>θ</strong>：現在の角度 [rad]</li> <li><strong>θ_max</strong>：最大回転角 [rad]</li> </ul> <h3>4.2 電気的特性</h3> <h4>分圧回路</h4> <p>\[V_{\text{out}} = V_{\text{supply}} \times \frac{R_2}{R_1 + R_2}\]</p> <h4>線形性</h4> <p>理想的な線形性は以下の式で表される：</p> <p>\[V_{\text{out}} = V_{\text{supply}} \times \frac{\theta}{\theta_{\max}} + V_{\text{offset}}\]</p> <h4>非線形性の要因</h4> <ol> <li><strong>抵抗体の不均一性</strong></li> <li><strong>接触抵抗の変動</strong></li> <li><strong>温度係数</strong></li> <li><strong>機械的摩耗</strong></li> </ol> <h3>4.3 材料と特性</h3> <h4>抵抗体材料</h4> <table> <tbody> <tr> </tr> <tr> <td><strong>炭素皮膜</strong></td> <td>1kΩ～1MΩ</td> <td>±20%</td> <td>-1000ppm/°C</td> <td>中</td> </tr> <tr> <td><strong>金属皮膜</strong></td> <td>100Ω～1MΩ</td> <td>±5%</td> <td>±100ppm/°C</td> <td>高</td> </tr> <tr> <td><strong>ワイヤー巻き</strong></td> <td>10Ω～100kΩ</td> <td>±1%</td> <td>±50ppm/°C</td> <td>最高</td> </tr> </tbody> </table> <h4>技術仕様</h4> <ul> <li><strong>回転角度</strong>：270°～360°</li> <li><strong>精度</strong>：±0.1%～±5%</li> <li><strong>分解能</strong>：理論上無限（実際は0.1°程度）</li> <li><strong>応答時間</strong>：即座</li> <li><strong>動作温度</strong>：-40°C～+125°C</li> <li><strong>振動耐性</strong>：10G</li> </ul> <h3>4.4 信号処理と補償</h3> <h4>非線形性補償</h4> <p>\[\theta_{\text{corrected}} = \theta_{\text{raw}} + f_{\text{correction}}(\theta_{\text{raw}})\]</p> <h4>温度補償</h4> <p>\[V_{\text{compensated}} = V_{\text{raw}} \times (1 + \alpha_T \times \Delta T)\]</p> <h4>ノイズ除去</h4> <p>\[V_{\text{filtered}} = V_{\text{raw}} \times (1 - \alpha) + V_{\text{previous}} \times \alpha\]</p> <h3>4.5 実装例：角度測定</h3> <pre>// ポテンショメータ読み取り例 float readPotentiometer() { int raw_value = analogRead(POT_PIN); float voltage = (raw_value / 1023.0) * 5.0; // 0-5Vに変換 // 角度計算（0-270度の場合） float angle = (voltage / 5.0) * 270.0; return angle; } // キャリブレーション例 void calibratePotentiometer() { float min_voltage = 0.0; float max_voltage = 5.0; // 最小値設定 Serial.println("最小位置に移動してEnterを押してください"); while (Serial.available() == 0); min_voltage = analogRead(POT_PIN) * 5.0 / 1023.0; Serial.read(); // 最大値設定 Serial.println("最大位置に移動してEnterを押してください"); while (Serial.available() == 0); max_voltage = analogRead(POT_PIN) * 5.0 / 1023.0; Serial.read(); // キャリブレーション係数保存 EEPROM.put(0, min_voltage); EEPROM.put(4, max_voltage); } </pre> <h2>5. レゾルバ（Resolver）</h2> <h3>5.1 動作原理</h3> <p>レゾルバは、電磁誘導を利用して角度を検出するアナログセンサーである。</p> <h4>基本構成</h4> <ul> <li><strong>ステータ</strong>：固定子、励磁コイルと検出コイル</li> <li><strong>ロータ</strong>：回転子、変調コイル</li> <li><strong>励磁信号</strong>：高周波正弦波（通常1-10kHz）</li> </ul> <h4>出力信号</h4> <p>\[V_{\sin} = K \times \sin(\theta) \times \sin(\omega t)\]</p> <p>\[V_{\cos} = K \times \cos(\theta) \times \sin(\omega t)\]</p> <p>ここで：</p> <ul> <li><strong>K</strong>：ゲイン定数</li> <li><strong>θ</strong>：回転角度 [rad]</li> <li><strong>ω</strong>：励磁角周波数 [rad/s]</li> <li><strong>t</strong>：時間 [s]</li> </ul> <h3>5.2 角度計算</h3> <h4>アークタンジェント法</h4> <p>\[\theta = \arctan2(V_{\sin}, V_{\cos})\]</p> <h4>4象限アークタンジェント</h4> <pre>float calculateAngle(float sin_val, float cos_val) { float angle = atan2(sin_val, cos_val); // 負の角度を正の角度に変換 if (angle < 0) { angle += 2 * PI; } return angle; } </pre> <h3>5.3 RDC（Resolver-to-Digital Converter）</h3> <h4>動作原理</h4> <p>RDCは、レゾルバのアナログ出力をデジタル角度に変換する専用ICである。</p> <h4>主要機能</h4> <ol> <li><strong>励磁信号生成</strong>：正弦波発振器</li> <li><strong>同期検波</strong>：位相敏感検波器</li> <li><strong>角度計算</strong>：アークタンジェント演算</li> <li><strong>デジタル出力</strong>：並列/シリアル出力</li> </ol> <h4>技術仕様</h4> <ul> <li><strong>分解能</strong>：10～16ビット</li> <li><strong>精度</strong>：±0.1°～±0.01°</li> <li><strong>応答時間</strong>：1～10ms</li> <li><strong>励磁周波数</strong>：1～10kHz</li> <li><strong>動作温度</strong>：-40°C～+125°C</li> </ul> <h3>5.4 ノイズ対策と補償</h3> <h4>ノイズ源</h4> <ol> <li><strong>電磁誘導ノイズ</strong></li> <li><strong>電源ノイズ</strong></li> <li><strong>熱雑音</strong></li> <li><strong>量子化ノイズ</strong></li> </ol> <h4>対策</h4> <ol> <li><strong>シールド配線</strong></li> <li><strong>差動信号</strong></li> <li><strong>フィルタリング</strong></li> <li><strong>冗長化</strong></li> </ol> <h4>実装例：レゾルバ読み取り</h4> <pre>// レゾルバ読み取り例 typedef struct { float sin_val; float cos_val; float angle; float prev_angle; int revolutions; } ResolverData; void readResolver(ResolverData* resolver) { // アナログ値読み取り int sin_raw = analogRead(SIN_PIN); int cos_raw = analogRead(COS_PIN); // 電圧に変換（-5V～+5V） resolver->sin_val = (sin_raw - 512) * 10.0 / 1023.0; resolver->cos_val = (cos_raw - 512) * 10.0 / 1023.0; // 角度計算 resolver->angle = atan2(resolver->sin_val, resolver->cos_val); // 回転数カウント float angle_diff = resolver->angle - resolver->prev_angle; if (angle_diff > PI) { resolver->revolutions--; } else if (angle_diff < -PI) { resolver->revolutions++; } resolver->prev_angle = resolver->angle; } // 絶対角度取得 float getAbsoluteAngle(ResolverData* resolver) { return resolver->angle + resolver->revolutions * 2 * PI; } </pre> <h2>6. タコジェネレータ（Tachogenerator）</h2> <h3>6.1 動作原理</h3> <p>タコジェネレータは、発電機の原理を利用して回転速度を電圧に変換するセンサーである。</p> <h4>基本構成</h4> <ul> <li><strong>永久磁石</strong>：固定子</li> <li><strong>電機子</strong>：回転子、コイル巻き</li> <li><strong>整流子</strong>：直流出力用</li> <li><strong>ブラシ</strong>：電流取り出し</li> </ul> <h4>出力電圧</h4> <p>\[V_{\text{out}} = K_t \times \omega\]</p> <p>ここで：</p> <ul> <li><strong>V_out</strong>：出力電圧 [V]</li> <li><strong>K_t</strong>：タコ定数 [V·s/rad]</li> <li><strong>ω</strong>：角速度 [rad/s]</li> </ul> <h3>6.2 信号処理</h3> <h4>速度計算</h4> <p>\[\omega = \frac{V_{\text{out}}}{K_t}\]</p> <h4>フィルタリング</h4> <p>\[V_{\text{filtered}} = V_{\text{raw}} \times (1 - \alpha) + V_{\text{previous}} \times \alpha\]</p> <h4>校正</h4> <pre>// タコジェネレータ校正例 void calibrateTachogenerator() { float known_speed = 1000.0; // rpm float voltage = analogRead(TACHO_PIN) * 5.0 / 1023.0; // タコ定数計算 float k_t = voltage / (known_speed * 2 * PI / 60.0); // EEPROMに保存 EEPROM.put(0, k_t); } // 速度読み取り float readSpeed() { float voltage = analogRead(TACHO_PIN) * 5.0 / 1023.0; float k_t; EEPROM.get(0, k_t); return voltage / k_t * 60.0 / (2 * PI); // rpmに変換 } </pre> <h3>6.3 技術仕様</h3> <table> <tbody> <tr> </tr> <tr> <td><strong>出力電圧</strong></td> <td>0～10V</td> </tr> <tr> <td><strong>タコ定数</strong></td> <td>1～100 V·s/rad</td> </tr> <tr> <td><strong>精度</strong></td> <td>±0.1%～±1%</td> </tr> <tr> <td><strong>応答時間</strong></td> <td>1～10ms</td> </tr> <tr> <td><strong>動作温度</strong></td> <td>-40°C～+125°C</td> </tr> <tr> <td><strong>振動耐性</strong></td> <td>20G</td> </tr> </tbody> </table> <h2>7. 力センサー（Force Sensors）</h2> <h3>7.1 ひずみゲージ式力センサー</h3> <h4>動作原理</h4> <p>ひずみゲージの抵抗変化を利用して力を検出する。</p> <h4>ひずみの定義</h4> <p>\[\varepsilon = \frac{\Delta L}{L} = \frac{L_{\text{final}} - L_{\text{initial}}}{L_{\text{initial}}}\]</p> <h4>抵抗変化</h4> <p>\[\frac{\Delta R}{R} = G \times \varepsilon\]</p> <p>ここで：</p> <ul> <li><strong>G</strong>：ゲージ率（通常2.0）</li> <li><strong>ε</strong>：ひずみ</li> </ul> <h4>ホイートストンブリッジ</h4> <p>\[V_{\text{out}} = V_{\text{supply}} \times \left(\frac{R_2}{R_1+R_2} - \frac{R_4}{R_3+R_4}\right)\]</p> <h3>7.2 圧電式力センサー</h3> <h4>動作原理</h4> <p>圧電効果を利用して力を電荷に変換する。</p> <h4>出力電荷</h4> <p>\[Q = d \times F\]</p> <p>ここで：</p> <ul> <li><strong>Q</strong>：出力電荷 [C]</li> <li><strong>d</strong>：圧電定数 [C/N]</li> <li><strong>F</strong>：力 [N]</li> </ul> <h3>7.3 信号処理と校正</h3> <h4>校正手順</h4> <ol> <li><strong>ゼロ点調整</strong></li> <li><strong>感度調整</strong></li> <li><strong>線形性確認</strong></li> <li><strong>温度補償</strong></li> </ol> <h4>実装例：力センサー読み取り</h4> <pre>// 力センサー読み取り例 typedef struct { float force; float prev_force; float filtered_force; float alpha; // フィルタ係数 } ForceSensor; void readForceSensor(ForceSensor* sensor) { int raw_value = analogRead(FORCE_PIN); float voltage = (raw_value - 512) * 10.0 / 1023.0; // -5V～+5V // 力に変換（校正係数使用） sensor->force = voltage * FORCE_SENSITIVITY; // ローパスフィルタ sensor->filtered_force = sensor->alpha * sensor->force + (1 - sensor->alpha) * sensor->filtered_force; } // 力制御例 void forceControl(float target_force, ForceSensor* sensor) { float error = target_force - sensor->filtered_force; float control_output = KP * error + KI * integral_error + KD * derivative_error; // モータ制御 setMotorSpeed(control_output); } </pre> <h2>8. 高度な信号処理技術</h2> <h3>8.1 適応制御（Adaptive Control）</h3> <h4>MRAC（Model Reference Adaptive Control）</h4> <p>\[u(t) = K_p \times e(t) + K_i \times \int e(t)dt + K_d \times \frac{de(t)}{dt}\]</p> <h4>パラメータ同定</h4> <pre>// 最小二乗法によるパラメータ同定 typedef struct { float theta[3]; // [Kp, Ki, Kd] float P[3][3]; // 共分散行列 float lambda; // 忘却係数 } ParameterEstimator; void updateParameters(ParameterEstimator* est, float input, float output) { float phi[3] = {input, integral_input, derivative_input}; // カルマンフィルタ更新 float S = 1.0 + phi[0]*est->P[0][0]*phi[0] + phi[1]*est->P[1][1]*phi[1] + phi[2]*est->P[2][2]*phi[2]; float K[3]; for (int i = 0; i < 3; i++) { K[i] = est->P[i][i] * phi[i] / S; est->theta[i] += K[i] * (output - phi[i] * est->theta[i]); } } </pre> <h3>8.2 ノイズ除去技術</h3> <h4>ウェーブレット変換</h4> <pre>// 簡易ウェーブレットフィルタ float waveletFilter(float* signal, int length, float threshold) { float filtered = 0.0; for (int i = 1; i < length - 1; i++) { float detail = signal[i] - (signal[i-1] + signal[i+1]) / 2.0; if (fabs(detail) < threshold) { filtered += signal[i]; } else { filtered += (signal[i-1] + signal[i+1]) / 2.0; } } return filtered / length; } </pre> <h2>9. まとめと技術比較</h2> <h3>9.1 センサー比較表</h3> <table> <tbody> <tr> </tr> <tr> <td><strong>エンコーダ</strong></td> <td>高</td> <td>高</td> <td>高</td> <td>中</td> <td>位置制御</td> </tr> <tr> <td><strong>ポテンショメータ</strong></td> <td>中</td> <td>中</td> <td>高</td> <td>低</td> <td>角度測定</td> </tr> <tr> <td><strong>レゾルバ</strong></td> <td>最高</td> <td>高</td> <td>中</td> <td>高</td> <td>高精度位置</td> </tr> <tr> <td><strong>タコジェネレータ</strong></td> <td>高</td> <td>中</td> <td>高</td> <td>中</td> <td>速度制御</td> </tr> <tr> <td><strong>力センサー</strong></td> <td>高</td> <td>高</td> <td>中</td> <td>高</td> <td>力制御</td> </tr> </tbody> </table> <h3>9.2 選択指針</h3> <h4>用途別選択</h4> <ol> <li><strong>位置制御</strong>：エンコーダ、レゾルバ</li> <li><strong>速度制御</strong>：タコジェネレータ、エンコーダ</li> <li><strong>力制御</strong>：力センサー</li> <li><strong>角度測定</strong>：ポテンショメータ</li> </ol> <h4>環境条件</h4> <ul> <li><strong>高温</strong>：レゾルバ、タコジェネレータ</li> <li><strong>振動</strong>：エンコーダ、力センサー</li> <li><strong>電磁ノイズ</strong>：レゾルバ、光ファイバーセンサー</li> </ul> <h3>9.3 システム統合の考慮事項</h3> <h4>信号処理</h4> <ul> <li><strong>サンプリング周波数</strong>：制御帯域の10倍以上</li> <li><strong>フィルタ設計</strong>：位相遅れの最小化</li> <li><strong>校正</strong>：定期的な校正による精度維持</li> </ul> <h4>補償技術</h4> <ul> <li><strong>温度補償</strong>：温度係数の考慮</li> <li><strong>非線形補償</strong>：校正データの活用</li> <li><strong>冗長化</strong>：安全性向上のための冗長構成</li> </ul> <h4>センサー選択フローチャート</h4> <pre>開始 ↓ 用途は？ → 位置制御 → 精度要求は？ → 高 → レゾルバ/アブソリュートエンコーダ ↓ ↓ ↓ 速度制御中 → インクリメンタルエンコーダ ↓ ↓ 力制御低 → ポテンショメータ ↓ タコジェネレータ/力センサー ↓ 環境条件確認 ↓ 最終選択 </pre> <h4>システム統合のベストプラクティス</h4> <ol> <li><strong>配線設計</strong> <ul> <li>シールドケーブルの使用</li> <li>電源線との分離</li> <li>適切な接地</li> </ul> </li> <li><strong>信号処理</strong> <ul> <li>適切なサンプリング周波数</li> <li>フィルタ設計</li> <li>校正の自動化</li> </ul> </li> <li><strong>冗長化</strong> <ul> <li>複数センサーの併用</li> <li>故障検出機能</li> <li>フェイルセーフ設計</li> </ul> </li> </ol> <h4>最新技術動向</h4> <ol> <li><strong>MEMSセンサー</strong> <ul> <li>小型化、低コスト化</li> <li>高精度化の進展</li> <li>統合化の進歩</li> </ul> </li> <li><strong>光ファイバーセンサー</strong> <ul> <li>電磁ノイズ耐性</li> <li>長距離伝送</li> <li>高精度</li> </ul> </li> <li><strong>AI/ML活用</strong> <ul> <li>異常検出</li> <li>予知保全</li> <li>適応制御</li> </ul> </li> </ol> <p>内界センサーは、ロボット制御システムの根幹を成す重要な要素であり、適切な選択と信号処理により、高精度で信頼性の高い制御を実現する。</p> <h2>参考文献・関連リンク</h2> <h3>学術文献</h3> <ul> <li>Craig, J.J. (2017). <em>Introduction to Robotics: Mechanics and Control</em>. 4th Edition, Pearson.</li> <li>Siciliano, B., Sciavicco, L., Villani, L., & Oriolo, G. (2009). <em>Robotics: Modelling, Planning and Control</em>. Springer.</li> <li>Spong, M.W., Hutchinson, S., & Vidyasagar, M. (2020). <em>Robot Modeling and Control</em>. 2nd Edition, Wiley.</li> <li>Franklin, G.F., Powell, J.D., & Emami-Naeini, A. (2018). <em>Feedback Control of Dynamic Systems</em>. 8th Edition, Pearson.</li> <li>Ogata, K. (2010). <em>Modern Control Engineering</em>. 5th Edition, Prentice Hall.</li> </ul> <h3>技術資料</h3> <ul> <li>IEEE Robotics and Automation Society: <a href="https://www.ieee-ras.org/">https://www.ieee-ras.org/</a></li> <li>ROS (Robot Operating System) Documentation: <a href="https://ros.org/">https://ros.org/</a></li> <li>Robot Sensors - IEEE Spectrum: <a href="https://spectrum.ieee.org/topic/robotics/sensors/">https://spectrum.ieee.org/topic/robotics/sensors/</a></li> <li>Sensor Technology Handbook: <a href="https://www.analog.com/en/technical-articles/sensor-technology-handbook.html">https://www.analog.com/en/technical-articles/sensor-technology-handbook.html</a></li> <li>National Instruments - Sensor Fundamentals: <a href="https://www.ni.com/en-us/innovations/white-papers/06/sensor-fundamentals.html">https://www.ni.com/en-us/innovations/white-papers/06/sensor-fundamentals.html</a></li> </ul> <h3>主要メーカー</h3> <ul> <li><strong>エンコーダ</strong>: HEIDENHAIN, Renishaw, Tamagawa, Omron, Sick</li> <li><strong>ポテンショメータ</strong>: Bourns, Vishay, Honeywell, Alps Alpine, Panasonic</li> <li><strong>レゾルバ</strong>: Tamagawa, HEIDENHAIN, Moog, Kollmorgen, Danaher</li> <li><strong>力センサー</strong>: ATI Industrial Automation, Kistler, HBM, Futek, Interface</li> <li><strong>タコジェネレータ</strong>: Maxon, Faulhaber, Oriental Motor, Yaskawa</li> </ul> <h3>規格・認証</h3> <ul> <li><strong>ISO 9409</strong>: 産業用ロボットの機械インターフェース</li> <li><strong>IEC 61800</strong>: 電気駆動システム</li> <li><strong>IEEE 1451</strong>: スマートセンサーインターフェース</li> <li><strong>CE Marking</strong>: 欧州適合性認証</li> <li><strong>UL Listing</strong>: 米国安全認証</li> </ul> <h3>免責事項</h3> <p>本資料は教育目的で作成されており、実際のシステム設計時は最新の技術仕様を確認してください。記載されている数値や仕様は一般的な参考値であり、特定の製品や用途を保証するものではありません。</p> <h3>ライセンス</h3> <p>この文書は Creative Commons Attribution-ShareAlike 4.0 International License の下で公開されています。</p> Dublin Core The Dublin Core metadata element set is common to all Omeka records, including items, files, and collections. For more information see, http://dublincore.org/documents/dces/. Title A name given to the resource ロボット工学２ Creator An entity primarily responsible for making the resource unjuno Rights Information about rights held in and over the resource CC BY 4.0