古人智慧

Just Do it!
上士聞道,勤而行之;中士聞道,若存若亡;下士聞道,大笑之。不笑,不足以爲道。
~ 道德經 41

「實現夢想不是追逐成功,而是在於賦予生命意義,人生中的每個決定與聲音都有其重要含義。」"The key to realizing a dream is to focus not on success but on significance — and then even the small steps and little victories along your path will take on greater meaning."
電視名人-歐普拉·溫芙蕾(OPRAH WINFREY)

搜尋此網誌

Translation

2016年6月2日 星期四

[Mini B-Car]2輪平衡車 ﹣ Balance car - Standup 2/xx

正職工作不是很順利,讓人煩心~
設計平衡車的軟件主要的部分
1. MPU6050 init & calibration
2. Read the acc & gyro value
3. timer interrupt - 10ms
4. wheel counter by interrupt way
5. PID calculation
6. PWM control with deadzone of motor

我先把MPU6050的部分搞定,把Acc與Gyro的值讀出來。然後把PID的P先實現出來,就可以讓車子站起來。


流程圖:
車身會前後搖擺產生加速度與角速度,每10ms讀取MPU6050的值,然後算出車身現狀的角度,然後乘上一個固定值來產生PWM(50~255)來控制馬達電機。
《圖待補充》



影片欣賞:





這是尚未設計馬達編碼的部分,所以小車在直立狀態下會滑動的現象。
下一章解說編碼器的code來分析正逆轉。

接下來,準備補齊PID演算法,還有可以前進後退與轉彎。


沒有留言:

張貼留言