亚洲欧美日韩一区二区在线观看,无码免费无码又爽高潮喷水网站

標(biāo)題: Dynamixel數(shù)字舵機(jī)驅(qū)動 [打印本頁]

作者: liuqq 時間: 2015-5-21 23:17
標(biāo)題: Dynamixel數(shù)字舵機(jī)驅(qū)動
好久沒更新技術(shù)類日志了，今天更新下，這是一個韓國robotics機(jī)器人Dynamixel數(shù)字舵機(jī)的驅(qū)動，采用C語言編寫，支持Dynamixel 通信協(xié)議，案例是AVR單片。實際上可以采用FPGA，例如SOPC系統(tǒng)上，可控制小型機(jī)器人。

在這也拆解下CM-5的控制器，是一片atmega128A 哦！哈哈。這PCB做工一般，感覺韓國人是科技領(lǐng)域爆發(fā)戶，但我們有什么資格嘲笑棒子呢，至少人家都能造CPU了，我們呢？

#include <avr/io.h>
#include <util/delay.h>
void InitUart0(void)
{
UCSR0A = 0x02; // 設(shè)置為倍速模式
UBRR0H = 0;
UBRR0L = 1;
UCSR0B = (1<<RXEN)|(1<<TXEN);// 接收器與發(fā)送器使能
UCSR0C = (3<<UCSZ0);
DDRE &= ~_BV(PE0); // 初始化RX 端口默認(rèn)方向為輸入
PORTE &= ~_BV(PE0); // 初始化RX 端口默認(rèn)狀態(tài)為高阻
DDRE |= _BV(PE1); // 初始化TX 端口默認(rèn)方向為輸出
PORTE |= _BV(PE1); // 初始化TX 端口默認(rèn)狀態(tài)為高電平
DDRA |= _BV(PA0); // 初始化使能端口狀態(tài)方向為輸出
PORTA &= ~_BV(PA0); // 初始化使能端口狀態(tài)為RX 狀態(tài)
DDRA |= _BV(PA1); // 初始化使能端口狀態(tài)方向為輸出
PORTA |= _BV(PA1); // 初始化使能端口狀態(tài)方為TX 狀態(tài)
}
void SendUart0Byte(unsigned char data)
{
while ( !( UCSR0A & (1<<UDRE)) );// 等待發(fā)送緩沖器為空
UDR0 = data;/* 將數(shù)據(jù)放入緩沖器，發(fā)送數(shù)據(jù)*/
}
void SetServoLimit(unsigned char id, unsigned short int cw_limit, unsigned short int ccw_limit)
{
unsigned short int temp_ccw = 0; // 臨時速度，用于進(jìn)行方向判別
unsigned short int temp_cw = 0;
unsigned char temp_ccw_h = 0; // 待發(fā)送數(shù)據(jù)h 位
unsigned char temp_ccw_l = 0; // 待發(fā)送數(shù)據(jù)l 位
unsigned char temp_cw_h = 0;
unsigned char temp_cw_l = 0;
unsigned char temp_sum = 0; // 校驗和寄存變量

if (ccw_limit > 1023)
{
temp_ccw = 1023; // 限制速度值在可用范圍內(nèi)
}
else
{
temp_ccw = ccw_limit;
}
if (cw_limit > 1023)
{
temp_cw = 1023;
}
else
{
temp_cw = cw_limit;
}
temp_ccw_h = (unsigned char)(temp_ccw >> 8);
temp_ccw_l = (unsigned char)temp_ccw; // 將16bit 數(shù)據(jù)拆為2個8bit 數(shù)據(jù)
temp_cw_h = (unsigned char)(temp_cw >> 8);
temp_cw_l = (unsigned char)temp_cw; // 將16bit 數(shù)據(jù)拆為2個8bit 數(shù)據(jù)
PORTA &= ~_BV(PA1);
PORTA |= _BV(PA0); // 使總線處于主機(jī)發(fā)送狀態(tài)
UCSR0A |= (1<<TXC0); // 清除UART0寫完成標(biāo)志
SendUart0Byte(0xFF); // 發(fā)送啟動符號0xFF
SendUart0Byte(0xFF); // 發(fā)送啟動符號0xFF
SendUart0Byte(id); // 發(fā)送id
SendUart0Byte(7); // 發(fā)送數(shù)據(jù)長度為參數(shù)長度+2，參數(shù)長度為3
SendUart0Byte(0x03); // 命令數(shù)據(jù)為“WRITE DATA”
SendUart0Byte(0x06); // 舵機(jī)控制寄存器首地址
SendUart0Byte(temp_cw_l); // 發(fā)送順時針位置限制低位
SendUart0Byte(temp_cw_h); // 發(fā)送順時針位置限制高位
SendUart0Byte(temp_ccw_l); // 發(fā)送逆時針位置限制低位
SendUart0Byte(temp_ccw_h); // 發(fā)送逆時針位置限制高位
temp_sum = id + 7 + 0x03 + 0x06 + temp_cw_l + temp_cw_h + temp_ccw_l + temp_ccw_h;
temp_sum = ~temp_sum; // 計算校驗和
SendUart0Byte(temp_sum); // 發(fā)送校驗和
while ( !( UCSR0A & (1<<TXC0)) ) // 等待發(fā)送完成
{ // (Waiting for finishing sending)
;
}
PORTA |= _BV(PA1);
PORTA &= ~_BV(PA0); // 使總線處于主機(jī)接收狀態(tài)
_delay_ms(2); //送完成后，總線會被從機(jī)占用，反饋應(yīng)答數(shù)據(jù)，所以進(jìn)行延時
}
void SetServoPosition(unsigned char id, unsigned short int position, unsigned short int
velocity)
{
unsigned short int temp_velocity = 0; // 臨時速度，用于進(jìn)行方向判別
unsigned short int temp_position = 0;
unsigned char temp_velocity_h = 0; // 待發(fā)送數(shù)據(jù)h 位
unsigned char temp_velocity_l = 0; // 待發(fā)送數(shù)據(jù)l 位
unsigned char temp_position_h = 0;
unsigned char temp_position_l = 0;
unsigned char temp_sum = 0; // 校驗和寄存變量
if (velocity > 1023)
{
temp_velocity = 1023; // 限制速度值在可用范圍內(nèi)
}
else
{
temp_velocity = velocity;
}
if (position > 1023)
{
temp_position = 1023;
}
else
{
temp_position = position;
}
temp_velocity_h = (unsigned char)(temp_velocity >> 8);
// 將16bit 數(shù)據(jù)拆為2個8bit 數(shù)據(jù)
temp_velocity_l = (unsigned char)temp_velocity;
temp_position_h = (unsigned char)(temp_position >> 8);
// 將16bit 數(shù)據(jù)拆為2個8bit 數(shù)據(jù)
temp_position_l = (unsigned char)temp_position;
PORTA &= ~_BV(PA1);
PORTA |= _BV(PA0); // 使總線處于主機(jī)發(fā)送狀態(tài)
UCSR0A |= (1<<TXC0); // 清除UART0寫完成標(biāo)志
SendUart0Byte(0xFF); // 發(fā)送啟動符號0xFF
SendUart0Byte(0xFF);
SendUart0Byte(id); // 發(fā)送id
SendUart0Byte(7); // 發(fā)送數(shù)據(jù)長度為參數(shù)長度+2，參數(shù)長度為3
SendUart0Byte(0x03); // 命令數(shù)據(jù)為“WRITE DATA”
SendUart0Byte(0x1E); // 舵機(jī)控制寄存器首地址
SendUart0Byte(temp_position_l); // 發(fā)送速度數(shù)據(jù)低位
SendUart0Byte(temp_position_h); // 發(fā)送速度數(shù)據(jù)高位
SendUart0Byte(temp_velocity_l); //發(fā)送位置低字節(jié)
SendUart0Byte(temp_velocity_h); // 發(fā)送位置高字節(jié)
temp_sum = id + 7 + 0x03 + 0x1E + temp_position_l + temp_position_h + temp_velocity_l +
temp_velocity_h;
temp_sum = ~temp_sum; // 計算校驗和
SendUart0Byte(temp_sum); // 發(fā)送校驗和 (Send the checksum)
while ( !( UCSR0A & (1<<TXC0)) ) // 等待發(fā)送完成
{ // (Waiting for finishing sending)
;
}
PORTA |= _BV(PA1);
PORTA &= ~_BV(PA0); // 使總線處于主機(jī)接收狀態(tài)
_delay_ms(2); // 發(fā)送完成后，總線會被從機(jī)占用，反饋應(yīng)答數(shù)據(jù)，所以進(jìn)行延時
}
void SetServoVelocity(unsigned char id, signed short int velocity)
{
unsigned char temp_sign = 0; // 臨時符號，用于進(jìn)行方向判別
unsigned short int temp_velocity = 0; // 臨時速度，用于進(jìn)行方向判別
unsigned char temp_value_h = 0; // 待發(fā)送數(shù)據(jù)h 位
unsigned char temp_value_l = 0; // 待發(fā)送數(shù)據(jù)l 位
unsigned char temp_sum = 0; // 校驗和寄存變量
if (velocity < 0)
{
temp_velocity = -velocity; // 如果為負(fù)數(shù)，則取絕對值
temp_sign = 1; // 設(shè)置負(fù)數(shù)符號標(biāo)志
}
else
{
temp_velocity = velocity;
temp_sign = 0; // 設(shè)置正數(shù)符號標(biāo)志
}
if (temp_velocity > 1023)
{
temp_velocity = 1023; // 限制速度值在可用范圍內(nèi)
}
temp_velocity |= (temp_sign << 10);
temp_value_h = (unsigned char)(temp_velocity >> 8);
// 將16bit 數(shù)據(jù)拆為2個8bit 數(shù)據(jù)
temp_value_l = (unsigned char)temp_velocity;
PORTA &= ~_BV(PA1);
PORTA |= _BV(PA0); // 使總線處于主機(jī)發(fā)送狀態(tài)
UCSR0A |= (1<<TXC0); // 清除UART0寫完成標(biāo)志
SendUart0Byte(0xFF); // 發(fā)送啟動符號0xFF
SendUart0Byte(0xFF); // 發(fā)送啟動符號0xFF
SendUart0Byte(id); // 發(fā)送id
SendUart0Byte(5); // 發(fā)送數(shù)據(jù)長度為參數(shù)長度+2，參數(shù)長度為3
SendUart0Byte(0x03); // 命令數(shù)據(jù)為“WRITE DATA”
SendUart0Byte(0x20); // 舵機(jī)控制寄存器首地址
SendUart0Byte(temp_value_l); // 發(fā)送速度數(shù)據(jù)低位
SendUart0Byte(temp_value_h); // 發(fā)送速度數(shù)據(jù)高位
temp_sum = id + 5 + 0x03 + 0x20 + temp_value_l + temp_value_h;
temp_sum = ~temp_sum; // 計算校驗和
SendUart0Byte(temp_sum); // 發(fā)送校驗和
while ( !( UCSR0A & (1<<TXC0)) ) // 等待發(fā)送完成
{
;
}
PORTA |= _BV(PA1);
PORTA &= ~_BV(PA0); // 使總線處于主機(jī)接收狀態(tài)
_delay_ms(2); // 發(fā)送完成后，總線會被從機(jī)占用，反饋應(yīng)答數(shù)據(jù)，所以進(jìn)行延時
}
int main(void)
{
InitUart0();
SetServoLimit(2,0,1023);
while(1)
  {
_delay_ms(1000); //延時1s
SetServoPosition(2, 1000, 500); //控制舵機(jī)以500的速度運(yùn)動到1000的位置
_delay_ms(1000); //延時1s
SetServoPosition(2, 200, 100); //控制舵機(jī)以100的速度運(yùn)動到200的位置

  }
}

作者: 火狐free 時間: 2016-7-14 17:13
新手求教：前輩您好，很冒昧給您消息向您求助，希望能請教一點(diǎn)問題，在此現(xiàn)向您表示感謝。對于使用舵機(jī)來說，我是一個新手，現(xiàn)在需要調(diào)試一個MX-28R舵機(jī)，起初使用RoboPlus連接是識別了舵機(jī)的。然后我想修改舵機(jī)ID號和波特率，我就根據(jù)pdf文檔在軟件界面操作了，但我發(fā)現(xiàn)設(shè)置了幾次，ID號和波特率并沒有改變；然后我就腦殘了一下，想著先關(guān)閉，重新打開軟件連接一下，再看ID號顯示是否改變，悲劇的是重啟軟件，竟然無法搜索到Dynamixel了，真不知道怎么辦，十分著急。在此冒昧向您咨詢一下，還望您能給予些許指點(diǎn)，不勝感激！

作者: FEETECH 時間: 2017-1-21 23:21
FEETECH飛特舵機(jī)總線伺服驅(qū)動，采用SCS通訊協(xié)議，配有上位機(jī)操作軟件，具備溫度，位置，速度，電壓，電流反饋。寬電壓保護(hù)，堵轉(zhuǎn)過載保護(hù)，硬件采用自主研發(fā)的舵機(jī)控制板，進(jìn)口零配件，性能穩(wěn)定，每個舵機(jī)出廠均一一檢測。開發(fā)機(jī)器人、機(jī)械臂、工業(yè)、物流等可參考試用。

作者: daileiji 時間: 2017-1-26 21:07
怎么可以下載啊

作者: yuankee 時間: 2018-3-31 17:27
是把這段驅(qū)動程序放在程序里，就能用arduino控制AX-12A了嗎？

作者: yuankee 時間: 2018-3-31 17:28

火狐free 發(fā)表于 2016-7-14 17:13
新手求教：前輩您好，很冒昧給您消息向您求助，希望能請教一點(diǎn)問題，在此現(xiàn)向您表示感謝。對于使用舵機(jī)來 ...

robotplus哪里能弄到

歡迎光臨 (http://www.torrancerestoration.com/bbs/)