一種基于活動(dòng)腳輪的2D輪式機(jī)器人的運(yùn)動(dòng)控制方法

基本信息

申請(qǐng)?zhí)?/td> CN201810360530.5 申請(qǐng)日 -
公開（公告）號(hào) CN108563227A 公開（公告）日 2018-09-21
申請(qǐng)公布號(hào) CN108563227A 申請(qǐng)公布日 2018-09-21
分類號(hào) G05D1/02;G05D1/08 分類 控制；調(diào)節(jié);
發(fā)明人 崔競(jìng)松;郭遲;葛雯斐;陳梁;鄧玥;牛小驥 申請(qǐng)（專利權(quán)）人 中山賽伯坦智能科技有限公司
代理機(jī)構(gòu) 武漢科皓知識(shí)產(chǎn)權(quán)代理事務(wù)所（特殊普通合伙） 代理人 嚴(yán)彥
地址 430072 湖北省武漢市武昌區(qū)珞珈山武漢大學(xué)
法律狀態(tài) -

摘要

摘要 本發(fā)明公開一種基于活動(dòng)腳輪的2D輪式機(jī)器人的運(yùn)動(dòng)控制方法，包括按照以下流程不斷更新控制機(jī)器人運(yùn)動(dòng)狀態(tài)：步驟S1，根據(jù)任務(wù)需求確定當(dāng)前時(shí)刻機(jī)器人的目標(biāo)狀態(tài)；步驟S2，將機(jī)器人整體的運(yùn)動(dòng)表示為機(jī)器人底盤幾何中心P點(diǎn)的質(zhì)點(diǎn)的運(yùn)動(dòng)，根據(jù)目標(biāo)狀態(tài)計(jì)算當(dāng)前時(shí)刻機(jī)器人在全局坐標(biāo)系下的運(yùn)動(dòng)向量；步驟S3，以輪子側(cè)向不受力的原則計(jì)算各個(gè)輪子的轉(zhuǎn)速ni和車輪朝向與機(jī)器人局部坐標(biāo)系的X軸的夾角ψi；步驟S4，按各個(gè)輪子的轉(zhuǎn)速ni和夾角ψi調(diào)整輪子的狀態(tài)，實(shí)現(xiàn)控制機(jī)器人運(yùn)動(dòng)。本發(fā)明支持機(jī)器人實(shí)現(xiàn)前行、橫移、斜行、旋轉(zhuǎn)及其組合等運(yùn)動(dòng)方式，可以用于2個(gè)及以上等多個(gè)所述小腳輪的2D輪式機(jī)器人的運(yùn)動(dòng)控制，車輪的滑動(dòng)小，運(yùn)動(dòng)的穩(wěn)定性、靈活性更高。