本論文是製作一個類似毛毛蟲外型的三節式機器人，有二個關節各由一個直流馬達帶動其動作，我們分別以PC和FPGA來實現其控制目的，完成爬行、站立等動作。本機器人製作及控制由兩位同學合作完成，分別以三節式機器人之站立控制及三節式機器人之爬行控制二本論文呈現。本論文主要探討三節式機器人如何在不同的傾斜地面上保持平衡、站立。硬體方面，利用編碼器將位置訊號回授到控制系統，經由解碼後，以得到目前的馬達位置，另外在機器人的底部裝設傾斜器，以獲得目前的地面傾斜角度，使機器人能根據馬達位置和傾斜器角度而準確的計算出目前的重心 (Center of Gravity, COG) 位置。而在角度位置控制和平衡控制主要是使用模糊控制器，讓機器人能夠在不同摩擦力的地面上，皆能夠平穩順暢地站立成功。 The field of researching in robots is very extensive. Our three-link robot is simple of hardware in structure, but many functions. We control the robot to crawl, stand-up and lie-down successfully. The robot was made by three links and two joints, every joint was controlled by one motor. Two classmates worked together to manufacture and control this robot. They have written two theses, i.e., the standing and crawling control of a three-link robot, respectively. This thesis emphasizes how a three-link robot keeps balance and stands on a slope. The system of robot got the angle of inclination between the bottom of robot and the horizontal, the encoder return the signal of positional motor, and the signal of encoder was sent to the chip of FPGA or PC, then sent the control signal to the motors to make the variety of action after evaluate action and control algorithms. If the floor is in the range of 7 degrees, the robot can detect states and adjust it’s posture automatically, make sure of action was perfect smoothly. In the structure of hardware, we use PC or FPGA, D/A, A/D and noise filter circuit to complete the system of control.
