倒立振子実験装置（プーリーベルト駆動）

本研究室で製作した，DCモータで駆動される倒立振子系の実験装置を紹介します．DCモータはPWMドライバで駆動され，台車の位置および振子の振れ角はポテンショメータで測定されます．パソコンとDSP（エムティティ s-BOX）をコントローラとして使用し，プログラミング言語は，DSP付属のC言語を用いました．状態フィードバックによる倒立安定化や振り上げ安定化などの制御実験ができます．

設計図は2次元汎用CADソフトRootPro CAD Standard（フリーソフト）で作成しました．

本実験装置は，広範な制御実験ができるようにレール長を0.6mとして設計したものです．また，制御性向上のため，台車駆動部にプーリーベルト機構を採用しました．
本実験装置は，[0]で紹介したものです．

[0] 吉田，濱口，制御工学教育におけるOctave，Scilabの活用について，第53回自動制御連合講演会，pp.210-211，2010.11.4



図1　倒立振子実験装置



図2　倒立振子実験装置（台車部）



図3　倒立振子実験装置（台車駆動部）



図4　倒立振子実験装置（台車駆動部）



図5　倒立振子実験装置（台車駆動部）



図6　倒立振子実験装置（台車駆動部（従動プーリー部））



図7　倒立振子実験装置

状態フィードバック制御による台車系のステップ応答テストの動画（WMVファイル）　台車系を2次遅れ系（1/(1+Ts)^2，時定数T=0.12s）とし，矩形波入力（振幅a=0.15m）を与えました．応答波形をシミュレーション結果と重ね，制御性能を評価します．

状態フィードバック制御による倒立振子の安定化制御実験の動画（WMVファイル）　飽和制御[1]によって安定化しました（台車移動幅の上限を0.3mと設定）．振子が止まるのは，振子部や台車駆動部の摩擦による不感帯のためです．

状態フィードバック制御による直列二重倒立振子の安定化制御実験の動画（WMVファイル）　飽和制御（[1]の拡張形）によって安定化しました（台車移動幅の上限を0.3mと設定）．倒立振子の安定化は，各（等価）振子長を長くすればより簡単になり，小さな出力のモータでも可能となります．

いずれもLQや極配置法でも安定化可能と思います．

[1] K.Yoshida and I. Matsumoto, ``Stabilizing control for an inverted pendulum with restricted travel, Proceedings of the 2009 American Control Conference, pp. 543-548, 2009.

図面1(PDF)
図面2(PDF)

倒立安定化制御サンプルプログラム（ipendpb_sample.c）　本プログラムは台車制御サンプルプログラム（cart_sample.c）を基に作成しました．上記の動画の実験（台車系，一重倒立振子）で使用したプログラムです．

部品表