基于16\32位DSP機(jī)器人控制系統(tǒng)設(shè)計與實現(xiàn)（普通高等教育十一五國家級規(guī)劃教材）

第0章  機(jī)器人學(xué)的發(fā)展和相關(guān)機(jī)器人系統(tǒng)介紹    1
0.1  機(jī)器人學(xué)的發(fā)展概述    1
0.2  機(jī)器人研究的熱點和內(nèi)容    2
0.2.1  機(jī)械結(jié)構(gòu)設(shè)計    2
0.2.2  體系結(jié)構(gòu)設(shè)計    2
0.2.3  多機(jī)器人系統(tǒng)的研究    3
0.2.4  機(jī)器人的傳感器和傳感器信息融合    4
0.2.5  機(jī)器人的電路系統(tǒng)設(shè)計    5
0.3  足球機(jī)器人簡介    6
0.3.1  足球機(jī)器人主要組成部分    6
0.3.2  研究足球機(jī)器人的意義    8
0.4  自平衡兩輪電動車簡介    9
0.5  倒立擺機(jī)器人系統(tǒng)概述    10
第1部分  基礎(chǔ)理論
第1章  DSP概述    12
1.1  DSP的特點    12
1.2  TI公司的DSP產(chǎn)品    14
第2章  TMS320LF240x概述    17
2.1  TMS320C2000系列DSP概況    17
2.2  TMS320LF240x芯片特點    17
2.3  TMS320LF240x DSP的PGE封裝圖和CPU控制器功能結(jié)構(gòu)圖    18
2.4  TMS320LF240x DSP引腳功能    21
2.5  TMS320LF240x DSP存儲器映射圖    27
2.6  TMS320LF240x DSP外設(shè)存儲器映射圖    30
2.7  TMS320LF240x的存儲器和IO空間    31
2.7.1  程序存儲器    31
2.7.2  數(shù)據(jù)存儲器    32
2.7.3  I/O空間    34
第3章  TMS320LF240x DSP內(nèi)部資源    35
3.1  TMS320LF240x DSP的CPU功能模塊    35
3.1.1  狀態(tài)寄存器ST0和ST1    38
3.1.2  輸入定標(biāo)移位器    40
3.1.3  乘法器    41
3.1.4  中央算術(shù)邏輯部分    42
3.1.5  輔助寄存器算術(shù)單元（ARAU）    43
3.2  系統(tǒng)配置和中斷    45
3.2.1  系統(tǒng)配置寄存器    47
3.2.2  中斷優(yōu)先級和中斷向量表    51
3.2.3  外設(shè)中斷擴(kuò)展控制器（PIE）    54
3.2.4  中斷向量    56
3.2.5  中斷響應(yīng)的流程    57
3.2.6  中斷響應(yīng)的延時    58
3.2.7  CPU中斷寄存器    58
3.2.8  外設(shè)中斷寄存器    61
3.2.9  復(fù)位    67
3.2.10  無效地址檢測    67
3.2.11  外部中斷控制寄存器    67
3.3  程序控制    69
3.3.1  程序地址的產(chǎn)生    69
3.3.2  流水線操作    72
3.3.3  轉(zhuǎn)移、調(diào)用和返回    73
3.3.4  條件轉(zhuǎn)移、調(diào)用和返回    74
3.3.5  重復(fù)單條指令    76
第4章  TMS320C28x系列概述    77
4.1  TMS320C28x系列芯片的性能    77
4.2  TMS320F28x系列DSP的引腳及其功能    79
4.3  C28x系列DSP的內(nèi)部結(jié)構(gòu)    92
第5章  C28x系列DSP內(nèi)部資源介紹    98
5.1  中央處理器單元CPU    98
5.1.1  CPU的邏輯圖及特性    99
5.1.2  CPU的結(jié)構(gòu)及其總線    100
5.1.3  CPU的寄存器    101
5.2  時鐘和系統(tǒng)控制    106
5.2.1  時鐘信號和控制寄存器    106
5.2.2  振蕩器OSC和鎖相環(huán)PLL時鐘模塊    107
5.2.3  低功耗方式模塊    109
5.2.4  看門狗模塊    110
5.3  CPU的中斷系統(tǒng)和復(fù)位    110
5.3.1  CPU中斷向量和優(yōu)先級    112
5.3.2  CPU中斷寄存器    113
5.3.3  可屏蔽中斷處理的標(biāo)準(zhǔn)操作流程    113
5.3.4   不可屏蔽中斷    114
5.4  片內(nèi)外設(shè)的中斷擴(kuò)展（PIE）    115
5.4.1  向量映射    116
5.4.2  從外設(shè)到CPU的多通道中斷請求流程    118
5.4.3  PIE向量表    118
5.5  32位CPU定時器0/1/2    125
5.5.1  CPU定時器的寄存器    126
第6章  C語言程序編寫和調(diào)試環(huán)境    131
6.1  TMS320C2x/C2xx/C5x C編譯器概述    131
6.2  TMC320C2x/C2xx/C5x C編譯器環(huán)境    132
6.2.1  主要菜單及功能介紹    134
6.2.2  工作窗口區(qū)    137
6.2.3  利用TMC320C2x/C2xx/C5x C編譯器開發(fā)應(yīng)用程序    139
6.2.4  頭文件和命令文件示例    142
第2部分  RoboCup小型組機(jī)器人
第7章  RoboCup簡介    151
7.1  機(jī)器人足球比賽的起源和類型    151
7.2  小型組比賽    152
7.3  國內(nèi)外的相關(guān)進(jìn)展    153
7.3.1  國際領(lǐng)先隊伍介紹    153
7.3.2  國內(nèi)參賽隊伍介紹    154
7.4  小型組比賽系統(tǒng)    155
7.4.1  系統(tǒng)組成及其相互關(guān)系    155
7.4.2  視覺子系統(tǒng)    155
7.4.3  決策子系統(tǒng)    156
7.4.4  無線通信子系統(tǒng)    157
7.4.5  機(jī)器人車體子系統(tǒng)    159
第8章  底層系統(tǒng)設(shè)計    160
8.1  研究的出發(fā)點和發(fā)展趨勢    160
8.2  機(jī)構(gòu)設(shè)計概況    161
8.3  電路系統(tǒng)設(shè)計概況    164
第9章  機(jī)構(gòu)設(shè)計    166
9.1  機(jī)構(gòu)設(shè)計流程    166
9.2  設(shè)計目標(biāo)    166
9.3  運動機(jī)構(gòu)的分析與設(shè)計    167
9.3.1  輪子的設(shè)計思想    167
9.3.2  輪子布局    171
9.4  球處理機(jī)構(gòu)的分析與設(shè)計    176
9.4.1  帶球機(jī)構(gòu)    176
9.4.2  擊球機(jī)構(gòu)    179
9.4.3  挑球機(jī)構(gòu)    181
第10章  電路系統(tǒng)分析與設(shè)計    185
10.1  電路系統(tǒng)總述    185
10.2  主控芯片的性能與工作方式    187
10.2.1  TMS320F2812    187
10.2.2  HCTL2000    188
10.3  通信系統(tǒng)    192
10.3.1  通信結(jié)構(gòu)    193
10.3.2  nRF2401    193
10.3.3  異步串行通信芯片ST16C550    194
10.4  各執(zhí)行機(jī)構(gòu)的驅(qū)動與控制電路    198
10.4.1  帶球機(jī)構(gòu)    198
10.4.2  運動機(jī)構(gòu)    199
10.4.3  擊球和挑球機(jī)構(gòu)    201
10.5  傳感器電路設(shè)計    203
10.5.1  球檢測電路    203
10.5.2  車體姿態(tài)傳感器    204
10.5.3  ADXL210JE    205
10.5.4  ADXRS300    208
10.6  輔助電路    213
10.6.1  74HC595    213
10.6.2  EEPROM    217
第11章  控制系統(tǒng)的實現(xiàn)    230
11.1  控制系統(tǒng)簡介    230
11.2  指令信息的接收與處理    230
11.3  機(jī)構(gòu)控制    236
11.3.1  帶球機(jī)構(gòu)    236
11.3.2  擊、挑球機(jī)構(gòu)    237
11.4  異常預(yù)防與處理    238
11.5  軟件實現(xiàn)    240
第12章  運動控制    242
12.1  綜述    242
12.2  基于動力學(xué)模型的實時次優(yōu)軌跡生成算法    243
12.2.1  建模    243
12.2.2  輸入域的解耦和分離    245
12.2.3  基于bang-bang控制的軌跡生成算法    247
12.2.4  軌跡同步    249
12.2.5  結(jié)果    250
12.3  底層運動控制    253
12.3.1  基于數(shù)字PI算法的電機(jī)調(diào)速    253
12.3.2  針對扭矩控制的改進(jìn)數(shù)字PI算法    255
12.3.3  基于強化學(xué)習(xí)的參數(shù)整定方法    257
第3部分  自平衡兩輪電動車
第13章  概述    260
13.1  自平衡兩輪電動車及其設(shè)計流程    260
13.1.1  自平衡兩輪電動車    260
13.1.2  自平衡兩輪電動車設(shè)計流程    261
第14章  系統(tǒng)動力學(xué)分析    263
14.1  力學(xué)分析    263
14.1.1  建立坐標(biāo)系    263
14.1.2  系統(tǒng)模型參數(shù)    263
14.1.3  系統(tǒng)速度    264
14.1.4  系統(tǒng)動能的計算    265
14.1.5  系統(tǒng)運動微分方程    267
14.2  系統(tǒng)參數(shù)的測量    270
14.2.1  理論基礎(chǔ)    270
14.2.2  硬件電路工作原理    271
14.2.3  參數(shù)測量    273
第15章  硬件設(shè)計    276
15.1  總體設(shè)計    276
15.2  DSP TMS320LF2407A    277
15.2.1  TMS320LF240xA概述    277
15.2.2  TMS320LF2407A    279
15.3  擺桿角度的測量    280
15.3.1  傳感器簡介    280
15.3.2  傾角傳感器    281
15.4  擺桿角速度的測量    284
15.4.1  微型固態(tài)陀螺MEMS角速度傳感器    284
15.4.2  ENC-03JA角速度傳感器    286
15.5  左右輪角速度的測量    288
15.5.1  E6B編碼器    288
15.5.2  碼盤信號檢測    290
15.6  電源和系統(tǒng)狀態(tài)指示    291
15.6.1  電源    291
15.6.2  系統(tǒng)狀態(tài)指示    292
15.7  功放電路    292
15.7.1  功率MOSFET簡介    292
15.7.2  驅(qū)動電路    294
第16章  系統(tǒng)調(diào)試、仿真平臺    296
16.1  TMS320LF2407A與PC機(jī)的串行通信    296
16.1.1  TMS320LF2407A的串行通信接口    296
16.1.2  電平轉(zhuǎn)換電路    300
16.1.3  PC端監(jiān)控軟件    301
16.2  TMS320LF2407A與PC機(jī)的無線通信    303
16.2.1  nRF2401簡介    304
16.2.2  nRF2401在自平衡兩輪電動車調(diào)試平臺中的應(yīng)用    306
16.3  PC端分析、仿真軟件——MATLAB    308
第17章  線性系統(tǒng)理論在自平衡兩輪電動車中的應(yīng)用    310
17.1  理論基礎(chǔ)    310
17.2  幾個重要的MATLAB函數(shù)    312
17.3  自平衡兩輪電動車狀態(tài)空間模型    313
17.4  自平衡兩輪電動車載人時的狀態(tài)反饋控制    315
17.4.1  系統(tǒng)狀態(tài)方程、能控性    315
17.4.2  第一種情況    316
17.4.3  第二種情況    318
17.4.4  第三種情況    320
17.4.5  三種情況的分析    322
第4部分  旋轉(zhuǎn)式倒立擺
第18章  倒立擺系統(tǒng)概述    324
18.1  倒立擺的基本概念    324
18.2  常見的倒立擺    325
第19章  硬件設(shè)計    328
19.1  系統(tǒng)總體設(shè)計方案    328
19.1.1  旋轉(zhuǎn)式倒立擺總體結(jié)構(gòu)    328
19.1.2  倒立擺系統(tǒng)工作原理    329
19.2  機(jī)械設(shè)計    330
19.3  DSP控制器    331
19.4  DSP的電源供電及時鐘選擇    335
19.4.1  供電方案    335
19.4.2  DSP的時鐘選擇    336
19.5  復(fù)位電路及MAX706    337
19.6  通信接口    339
19.7  角位移傳感器    340
19.8  無刷直流電機(jī)及控制電路    341
19.8.1  無刷直流電機(jī)的結(jié)構(gòu)及原理    341
19.8.2  使用dq變換求取無刷直流力矩電機(jī)系統(tǒng)的數(shù)學(xué)模型    343
19.8.3  無刷直流力矩電機(jī)系統(tǒng)的函數(shù)    344
19.8.4  無刷直流電機(jī)的力矩波動    345
19.8.5  電機(jī)驅(qū)動的設(shè)計    346
第20章  軟件設(shè)計    352
20.1  DSP程序總體設(shè)計與流程圖    352
20.2  DSP中斷服務(wù)子程序、寄存器    353
20.2.1  初始化子程序    353
20.2.2  脈寬調(diào)制控制輸出子程序初始化    355
20.2.3  串口通信子程序    355
20.2.4  采樣子程序    356
20.2.5  控制計算子程序    357
20.3  PC軟件設(shè)計    357
第21章  模型分析與控制算法設(shè)計    361
21.1  倒立擺模型分析    361
21.1.1  模型分析    361
21.1.2  試驗參數(shù)計算    363
21.2  基于狀態(tài)反饋的帶觀測器的倒立控制    364
21.3  基于能量分析的擺起控制    368
21.3.1  擺起控制的實現(xiàn)方法    368
21.3.2  “擺起－倒立”控制效果    369目    錄
第0章  機(jī)器人學(xué)的發(fā)展和相關(guān)機(jī)器人系統(tǒng)介紹    1
0.1  機(jī)器人學(xué)的發(fā)展概述    1
0.2  機(jī)器人研究的熱點和內(nèi)容    2
0.2.1  機(jī)械結(jié)構(gòu)設(shè)計    2
0.2.2  體系結(jié)構(gòu)設(shè)計    2
0.2.3  多機(jī)器人系統(tǒng)的研究    3
0.2.4  機(jī)器人的傳感器和傳感器信息融合    4
0.2.5  機(jī)器人的電路系統(tǒng)設(shè)計    5
0.3  足球機(jī)器人簡介    6
0.3.1  足球機(jī)器人主要組成部分    6
0.3.2  研究足球機(jī)器人的意義    8
0.4  自平衡兩輪電動車簡介    9
0.5  倒立擺機(jī)器人系統(tǒng)概述    10
第1部分  基礎(chǔ)理論
第1章  DSP概述    12
1.1  DSP的特點    12
1.2  TI公司的DSP產(chǎn)品    14
第2章  TMS320LF240x概述    17
2.1  TMS320C2000系列DSP概況    17
2.2  TMS320LF240x芯片特點    17
2.3  TMS320LF240x DSP的PGE封裝圖和CPU控制器功能結(jié)構(gòu)圖    18
2.4  TMS320LF240x DSP引腳功能    21
2.5  TMS320LF240x DSP存儲器映射圖    27
2.6  TMS320LF240x DSP外設(shè)存儲器映射圖    30
2.7  TMS320LF240x的存儲器和IO空間    31
2.7.1  程序存儲器    31
2.7.2  數(shù)據(jù)存儲器    32
2.7.3  I/O空間    34
第3章  TMS320LF240x DSP內(nèi)部資源    35
3.1  TMS320LF240x DSP的CPU功能模塊    35
3.1.1  狀態(tài)寄存器ST0和ST1    38
3.1.2  輸入定標(biāo)移位器    40
3.1.3  乘法器    41
3.1.4  中央算術(shù)邏輯部分    42
3.1.5  輔助寄存器算術(shù)單元（ARAU）    43
3.2  系統(tǒng)配置和中斷    45
3.2.1  系統(tǒng)配置寄存器    47
3.2.2  中斷優(yōu)先級和中斷向量表    51
3.2.3  外設(shè)中斷擴(kuò)展控制器（PIE）    54
3.2.4  中斷向量    56
3.2.5  中斷響應(yīng)的流程    57
3.2.6  中斷響應(yīng)的延時    58
3.2.7  CPU中斷寄存器    58
3.2.8  外設(shè)中斷寄存器    61
3.2.9  復(fù)位    67
3.2.10  無效地址檢測    67
3.2.11  外部中斷控制寄存器    67
3.3  程序控制    69
3.3.1  程序地址的產(chǎn)生    69
3.3.2  流水線操作    72
3.3.3  轉(zhuǎn)移、調(diào)用和返回    73
3.3.4  條件轉(zhuǎn)移、調(diào)用和返回    74
3.3.5  重復(fù)單條指令    76
第4章  TMS320C28x系列概述    77
4.1  TMS320C28x系列芯片的性能    77
4.2  TMS320F28x系列DSP的引腳及其功能    79
4.3  C28x系列DSP的內(nèi)部結(jié)構(gòu)    92
第5章  C28x系列DSP內(nèi)部資源介紹    98
5.1  中央處理器單元CPU    98
5.1.1  CPU的邏輯圖及特性    99
5.1.2  CPU的結(jié)構(gòu)及其總線    100
5.1.3  CPU的寄存器    101
5.2  時鐘和系統(tǒng)控制    106
5.2.1  時鐘信號和控制寄存器    106
5.2.2  振蕩器OSC和鎖相環(huán)PLL時鐘模塊    107
5.2.3  低功耗方式模塊    109
5.2.4  看門狗模塊    110
5.3  CPU的中斷系統(tǒng)和復(fù)位    110
5.3.1  CPU中斷向量和優(yōu)先級    112
5.3.2  CPU中斷寄存器    113
5.3.3  可屏蔽中斷處理的標(biāo)準(zhǔn)操作流程    113
5.3.4   不可屏蔽中斷    114
5.4  片內(nèi)外設(shè)的中斷擴(kuò)展（PIE）    115
5.4.1  向量映射    116
5.4.2  從外設(shè)到CPU的多通道中斷請求流程    118
5.4.3  PIE向量表    118
5.5  32位CPU定時器0/1/2    125
5.5.1  CPU定時器的寄存器    126
第6章  C語言程序編寫和調(diào)試環(huán)境    131
6.1  TMS320C2x/C2xx/C5x C編譯器概述    131
6.2  TMC320C2x/C2xx/C5x C編譯器環(huán)境    132
6.2.1  主要菜單及功能介紹    134
6.2.2  工作窗口區(qū)    137
6.2.3  利用TMC320C2x/C2xx/C5x C編譯器開發(fā)應(yīng)用程序    139
6.2.4  頭文件和命令文件示例    142
第2部分  RoboCup小型組機(jī)器人
第7章  RoboCup簡介    151
7.1  機(jī)器人足球比賽的起源和類型    151
7.2  小型組比賽    152
7.3  國內(nèi)外的相關(guān)進(jìn)展    153
7.3.1  國際領(lǐng)先隊伍介紹    153
7.3.2  國內(nèi)參賽隊伍介紹    154
7.4  小型組比賽系統(tǒng)    155
7.4.1  系統(tǒng)組成及其相互關(guān)系    155
7.4.2  視覺子系統(tǒng)    155
7.4.3  決策子系統(tǒng)    156
7.4.4  無線通信子系統(tǒng)    157
7.4.5  機(jī)器人車體子系統(tǒng)    159
第8章  底層系統(tǒng)設(shè)計    160
8.1  研究的出發(fā)點和發(fā)展趨勢    160
8.2  機(jī)構(gòu)設(shè)計概況    161
8.3  電路系統(tǒng)設(shè)計概況    164
第9章  機(jī)構(gòu)設(shè)計    166
9.1  機(jī)構(gòu)設(shè)計流程    166
9.2  設(shè)計目標(biāo)    166
9.3  運動機(jī)構(gòu)的分析與設(shè)計    167
9.3.1  輪子的設(shè)計思想    167
9.3.2  輪子布局    171
9.4  球處理機(jī)構(gòu)的分析與設(shè)計    176
9.4.1  帶球機(jī)構(gòu)    176
9.4.2  擊球機(jī)構(gòu)    179
9.4.3  挑球機(jī)構(gòu)    181
第10章  電路系統(tǒng)分析與設(shè)計    185
10.1  電路系統(tǒng)總述    185
10.2  主控芯片的性能與工作方式    187
10.2.1  TMS320F2812    187
10.2.2  HCTL2000    188
10.3  通信系統(tǒng)    192
10.3.1  通信結(jié)構(gòu)    193
10.3.2  nRF2401    193
10.3.3  異步串行通信芯片ST16C550    194
10.4  各執(zhí)行機(jī)構(gòu)的驅(qū)動與控制電路    198
10.4.1  帶球機(jī)構(gòu)    198
10.4.2  運動機(jī)構(gòu)    199
10.4.3  擊球和挑球機(jī)構(gòu)    201
10.5  傳感器電路設(shè)計    203
10.5.1  球檢測電路    203
10.5.2  車體姿態(tài)傳感器    204
10.5.3  ADXL210JE    205
10.5.4  ADXRS300    208
10.6  輔助電路    213
10.6.1  74HC595    213
10.6.2  EEPROM    217
第11章  控制系統(tǒng)的實現(xiàn)    230
11.1  控制系統(tǒng)簡介    230
11.2  指令信息的接收與處理    230
11.3  機(jī)構(gòu)控制    236
11.3.1  帶球機(jī)構(gòu)    236
11.3.2  擊、挑球機(jī)構(gòu)    237
11.4  異常預(yù)防與處理    238
11.5  軟件實現(xiàn)    240
第12章  運動控制    242
12.1  綜述    242
12.2  基于動力學(xué)模型的實時次優(yōu)軌跡生成算法    243
12.2.1  建模    243
12.2.2  輸入域的解耦和分離    245
12.2.3  基于bang-bang控制的軌跡生成算法    247
12.2.4  軌跡同步    249
12.2.5  結(jié)果    250
12.3  底層運動控制    253
12.3.1  基于數(shù)字PI算法的電機(jī)調(diào)速    253
12.3.2  針對扭矩控制的改進(jìn)數(shù)字PI算法    255
12.3.3  基于強化學(xué)習(xí)的參數(shù)整定方法    257
第3部分  自平衡兩輪電動車
第13章  概述    260
13.1  自平衡兩輪電動車及其設(shè)計流程    260
13.1.1  自平衡兩輪電動車    260
13.1.2  自平衡兩輪電動車設(shè)計流程    261
第14章  系統(tǒng)動力學(xué)分析    263
14.1  力學(xué)分析    263
14.1.1  建立坐標(biāo)系    263
14.1.2  系統(tǒng)模型參數(shù)    263
14.1.3  系統(tǒng)速度    264
14.1.4  系統(tǒng)動能的計算    265
14.1.5  系統(tǒng)運動微分方程    267
14.2  系統(tǒng)參數(shù)的測量    270
14.2.1  理論基礎(chǔ)    270
14.2.2  硬件電路工作原理    271
14.2.3  參數(shù)測量    273
第15章  硬件設(shè)計    276
15.1  總體設(shè)計    276
15.2  DSP TMS320LF2407A    277
15.2.1  TMS320LF240xA概述    277
15.2.2  TMS320LF2407A    279
15.3  擺桿角度的測量    280
15.3.1  傳感器簡介    280
15.3.2  傾角傳感器    281
15.4  擺桿角速度的測量    284
15.4.1  微型固態(tài)陀螺MEMS角速度傳感器    284
15.4.2  ENC-03JA角速度傳感器    286
15.5  左右輪角速度的測量    288
15.5.1  E6B編碼器    288
15.5.2  碼盤信號檢測    290
15.6  電源和系統(tǒng)狀態(tài)指示    291
15.6.1  電源    291
15.6.2  系統(tǒng)狀態(tài)指示    292
15.7  功放電路    292
15.7.1  功率MOSFET簡介    292
15.7.2  驅(qū)動電路    294
第16章  系統(tǒng)調(diào)試、仿真平臺    296
16.1  TMS320LF2407A與PC機(jī)的串行通信    296
16.1.1  TMS320LF2407A的串行通信接口    296
16.1.2  電平轉(zhuǎn)換電路    300
16.1.3  PC端監(jiān)控軟件    301
16.2  TMS320LF2407A與PC機(jī)的無線通信    303
16.2.1  nRF2401簡介    304
16.2.2  nRF2401在自平衡兩輪電動車調(diào)試平臺中的應(yīng)用    306
16.3  PC端分析、仿真軟件——MATLAB    308
第17章  線性系統(tǒng)理論在自平衡兩輪電動車中的應(yīng)用    310
17.1  理論基礎(chǔ)    310
17.2  幾個重要的MATLAB函數(shù)    312
17.3  自平衡兩輪電動車狀態(tài)空間模型    313
17.4  自平衡兩輪電動車載人時的狀態(tài)反饋控制    315
17.4.1  系統(tǒng)狀態(tài)方程、能控性    315
17.4.2  第一種情況    316
17.4.3  第二種情況    318
17.4.4  第三種情況    320
17.4.5  三種情況的分析    322
第4部分  旋轉(zhuǎn)式倒立擺
第18章  倒立擺系統(tǒng)概述    324
18.1  倒立擺的基本概念    324
18.2  常見的倒立擺    325
第19章  硬件設(shè)計    328
19.1  系統(tǒng)總體設(shè)計方案    328
19.1.1  旋轉(zhuǎn)式倒立擺總體結(jié)構(gòu)    328
19.1.2  倒立擺系統(tǒng)工作原理    329
19.2  機(jī)械設(shè)計    330
19.3  DSP控制器    331
19.4  DSP的電源供電及時鐘選擇    335
19.4.1  供電方案    335
19.4.2  DSP的時鐘選擇    336
19.5  復(fù)位電路及MAX706    337
19.6  通信接口    339
19.7  角位移傳感器    340
19.8  無刷直流電機(jī)及控制電路    341
19.8.1  無刷直流電機(jī)的結(jié)構(gòu)及原理    341
19.8.2  使用dq變換求取無刷直流力矩電機(jī)系統(tǒng)的數(shù)學(xué)模型    343
19.8.3  無刷直流力矩電機(jī)系統(tǒng)的函數(shù)    344
19.8.4  無刷直流電機(jī)的力矩波動    345
19.8.5  電機(jī)驅(qū)動的設(shè)計    346
第20章  軟件設(shè)計    352
20.1  DSP程序總體設(shè)計與流程圖    352
20.2  DSP中斷服務(wù)子程序、寄存器    353
20.2.1  初始化子程序    353
20.2.2  脈寬調(diào)制控制輸出子程序初始化    355
20.2.3  串口通信子程序    355
20.2.4  采樣子程序    356
20.2.5  控制計算子程序    357
20.3  PC軟件設(shè)計    357
第21章  模型分析與控制算法設(shè)計    361
21.1  倒立擺模型分析    361
21.1.1  模型分析    361
21.1.2  試驗參數(shù)計算    363
21.2  基于狀態(tài)反饋的帶觀測器的倒立控制    364
21.3  基于能量分析的擺起控制    368
21.3.1  擺起控制的實現(xiàn)方法    368
21.3.2  “擺起－倒立”控制效果    369
第22章  隨動系統(tǒng)    372
22.1  隨動系統(tǒng)的結(jié)構(gòu)和原理    372
22.1.1  把倒立擺改裝為隨動系統(tǒng)    372
22.1.2  電平轉(zhuǎn)換器    373
22.2  隨動系統(tǒng)穩(wěn)定性分析    375
22.3  隨動系統(tǒng)的時域特性分析    376
22.4  隨動系統(tǒng)的頻域特性分析    378
22.5  隨動系統(tǒng)的頻域校正實驗    380
附錄A  C-Lib中的函數(shù)集    385
附錄B  解耦圖形的推導(dǎo)    397
附錄C  電機(jī)調(diào)速程序    399
第22章  隨動系統(tǒng)    372
22.1  隨動系統(tǒng)的結(jié)構(gòu)和原理    372
22.1.1  把倒立擺改裝為隨動系統(tǒng)    372
22.1.2  電平轉(zhuǎn)換器    373
22.2  隨動系統(tǒng)穩(wěn)定性分析    375
22.3  隨動系統(tǒng)的時域特性分析    376
22.4  隨動系統(tǒng)的頻域特性分析    378
22.5  隨動系統(tǒng)的頻域校正實驗    380
附錄A  C-Lib中的函數(shù)集    385
附錄B  解耦圖形的推導(dǎo)    397
附錄C  電機(jī)調(diào)速程序    399