2016年3月13日 星期日

自平衡機器人的研究和實作



自平衡機器人的研究和實作
The Magic behind Self-Balancing Robot


專題的動機來自於 Dean Kamen 發明的兩輪電動代步車 ~ Segway。當人踏在上面時,可以自動平衡保持直立,且會根據整體重心的改變而產生前進或後退的靈活移動。因停靠方便、外型酷炫、操作容易,在歐美地區已造成一股流行。

主要的目標是完成一具有自我維持平衡能力的兩輪機器人。我們以STMicroelectronics STM32-F3 (ARM Cortex-M4 core @72MHz ) 當作開發平台,左、右兩輪各搭配有齒輪箱的直流馬達,底板正中央放置慣性感測元件,最上層安裝可充電式電池組。藉由Accelerometer 和 Gyroscope分別量測車身的傾斜角&角速度,並利用Encoder量測馬達轉動的位置或速度,根據前三者加總的即時資訊當成PID控制器的輸入,建立兩輪車各種模式的狀態;經運算後再以PWM訊號和驅動器輸出調整馬達轉速,使機器人具備平衡、同步、定速定位、前進/後退、左右轉彎等功能。

第一階段為實現保持動態平衡以及兩輪同步操作、第二階段為實現藍芽遙控的前進/後退和差速轉向。過程中整合了感測物理量的擷取、Kalman濾波器的訊號處理、馬達驅動&控制的技術,充份地展現了韌體&硬體的緊密結合,[系統架構圖]見Figure.2。



Keywords:  Self-Balancing, 慣性感測, Kalman濾波器, PID控制器,STM32-F3,ARM Cortex-M4,Accelerometer,Gyroscope




系統架構


成品圖

Slide:




Demo:




2 則留言 :

  1. Borgata Hotel Casino & Spa - JTR Hub
    Located in Atlantic City, www.jtmhub.com Borgata Hotel Casino & septcasino.com Spa offers the https://febcasino.com/review/merit-casino/ finest in amenities and entertainment. It also https://octcasino.com/ provides a 1xbet app seasonal outdoor swimming

    回覆刪除
  2. I just couldn't have loved you more.Then you posted this picture of me dropping my chin on the floor.

    스포츠토토
    안전놀이터
    카지노
    바카라사이트윈
    메이저사이트
    스포츠토토

    回覆刪除