兩輪自走車之設計與實現-以NIOS為核心之基本控制

Design and Implementation for A Two-wheel Vehicle - NIOS Based basic Control

李垂憲(Chui-Hsien Li)

指導教授 ： 王文俊

國立中央大學/資訊電機學院/電機工程學系/碩士(2006年)

摘要

本論文主要在設計與控制一輛具有自我維持平衡能力的兩輪車。整個系統以Nios CPU作為主控核心，是一種嵌入式系統與系統晶片（SOPC）的應用，整合馬達控制、電路訊號擷取、無線訊號傳輸與訊號處理的技術，並將模糊控制器建構在系統晶片本身，實現模糊控制的機器人系統。在控制流程上，使用傾斜器（Tilt）與陀螺儀（Gyro）分別量測車身的傾斜角度與角速度，另外使用馬達編碼器（Encoder）量測車子馬達轉動的角度及角速度。根據傾斜器、陀螺儀、馬達編碼器所回授的即時車身資訊當作輸入，建立車體各種行動模式的模糊控制器，計算輸出之後，以FPGA實現的PWM訊號來控制兩輪馬達的轉動，使得兩輪車具備平衡、定位、同步、左右轉向、前進與後退、停止、行走定速、上下坡等功能。在車身維持工作的期間，可利用無線數據機將車身所有資訊回傳至電腦端，藉由電腦端監控兩輪車的整體狀態，並可由遙控器下達行動的控制指令。

關鍵字

Segway ； 嵌入式系統 ； 機器人控制 ； 模糊控制

並列摘要

The purpose of this thesis is to design and control a self-balance two-wheel vehicle. NIOS CPU is the control center of the entire system, which includes fuzzy control algorithm, motor control, A/D converter, wireless communication and signal process etc. It is the whole applications of an embedded system and system on programmable chip （SOPC）. In control, the sensors tilt and gyro are used to measure the inclination angle and the angular velocity of the vehicle. Furthermore, the encoder is used to measure rotational rate and rotational angle of motors of the vehicle. The real-time vehicle information is selected for the inputs of every motion’s fuzzy controller. Through evaluating outputs of controllers, we use FPGA to implement PWM signals control motors of the vehicle. Finally, the two-wheel vehicle achieves self-balance, position fixing, synchronization, going forward and backward, walking with pace, making a turn, climbing up, going downhill, stopping and so on motions. All signals could be transmitted via wireless modules. However, not only the whole information of vehicle can be revealed by PC, but also the vehicle can be controlled by remote controller in our result.

並列關鍵字

Segway ； Embedded System ； Fuzzy Control ； Robot Control

參考文獻

[2] Y. Ha and S. Yuta, “Trajectory Tracking Control for Navigation of Self-Contained Mobile Inverse Pendulum,” IEEE/RSJ/GI Int. Conf. On Advanced Robotic Systems and the Real World'', vol. 3, pp. 12-16, September 1994.

[3] T. Miyashita and H. Ishiguro “Human-like natural behavior generation based on involuntary motions for humanoid robots,” Robotics and Autonomous System, Vol.48, pp. 203-212, 2004.

[4] J. Yi, N. Yubazaki and K. Hirota, “Upswing and Stabilization Control of Inverted Pendulum and Cart System by the SIRMs Dynamically Connected Fuzzy Inference Model,” IEEE International Fuzzy Systems Conference Proceedings, pp. 400-405, August 22-25, 1999.

[5] M. Sasaki, N. Yanagihara, O. Matsumoto and K. Komoriya, “Forward and Backward Motion Control of Personal Riding-type Wheeled Mobile Platform,” International Conference on Robotics & Automation, New Orieans, LA April 2004.

[1] F. Grasser, A. D''Arrigo, S. Colombi and A.C. Rufer, “JOE: a mobile, inverted pendulum,” IEEE Transactions on Industrial Electronics, Vol.39, No. 1, pp. 107-114, Feb. 2002.