松下伺服电机单圈绝对值编码器通讯

使用的是伺服驱动X2口的RS232通讯
主要是读取伺服电机的单圈绝对值数据。(PS:多圈绝对值需要进行初始清零,和配置带电池的线,掉电时不能随便转动电机,所以是伪绝对式)。

初始设定:

伺服驱动的Pr5.29参数设定为2(默认,9600波特率)
伺服驱动的Pr5.31参数设定为1(默认,轴的编号为1)

通讯协议为:
其中的h表示16进制

其中③中的数据(注意是16进制)为:00 01 D2 2D


数据块结构示意

那么③中的00表示命令字节数为0,01表示轴的编号,D2表示查询编码器状态,2D表示校验位。
⑦数据块返回的结构为:




以接受到的情况为例,⑦数据块具体为:0B 01 D2 0B A7 C1 14 9B 71 57 FE FF 00 00 3B
其中的9B 71 57是我们需要的编码器单圈绝对值位置数值。

接线情况:





其中蓝线接到伺服驱动的RX232口,棕色接到伺服驱动TX232口。黑色接地。
与电脑串口测试:

设置如下:



注意关闭了发送新行。
1、发送05,返回04,若超过10秒没有发送00 01 d2 2d,返回15(16进制)错误码。若下一步发送错误指令,立刻返回15(16进制)错误码。
2、发送00 01 d2 2d,返回 06 05,若超过10秒没有发送04,返回05错误码。若下一步输出指令为其他,比如05,则可以重新跳到相应指令(跳回1)。
3、发送04,返回0B 01 D2 0B A7 C1 14 B0 46 5D FE FF 00 00 4B,若超过10秒没有进行发送06,返回05错误码。若下一步输出指令为其他,比如05,则可以重新跳到相应指令(跳回1)。

与STM32通讯:
电路原理图

程序如下,选的是STM32F103ZET6的串口5(其他串口类似,基本上把UART5改为USARTX或UART4就行了):

u8 UART5_RX_BUF[20]; 
u8 U5_i;

void SERVO_CODE_Init(u32 bound)
{
    GPIO_InitTypeDef GPIO_InitStructure;
    USART_InitTypeDef USART_InitStructure;
    NVIC_InitTypeDef NVIC_InitStructure;
     
    RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC|RCC_APB2Periph_GPIOD, ENABLE);  //使能UART5,GPIOC、GPIOD时钟
    RCC_APB1PeriphClockCmd(RCC_APB1Periph_UART5, ENABLE);
  
    //UART5_TX   GPIOC.12初始化
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12; //PC.12
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; //复用推挽输出
    GPIO_Init(GPIOC, &GPIO_InitStructure);//初始化GPIOC.12
   
    //UART5_RX    GPIOD.2初始化
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2;//PD.2
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入
    GPIO_Init(GPIOD, &GPIO_InitStructure);//初始化GPIOD.2  

    //UART5 NVIC 配置
    NVIC_InitStructure.NVIC_IRQChannel = UART5_IRQn;
    NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=1;//抢占优先级1
    NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;      //子优先级3
    NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;         //IRQ通道使能
    NVIC_Init(&NVIC_InitStructure); //根据指定的参数初始化VIC寄存器
  
   //USART 初始化设置
    USART_InitStructure.USART_BaudRate = bound;//串口波特率
    USART_InitStructure.USART_WordLength = USART_WordLength_8b;//字长为8位数据格式
    USART_InitStructure.USART_StopBits = USART_StopBits_1;//一个停止位
    USART_InitStructure.USART_Parity = USART_Parity_No;//无奇偶校验位
    USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;//无硬件数据流控制
    USART_InitStructure.USART_Mode = USART_Mode_Rx | USART_Mode_Tx; //收发模式

    USART_Init(UART5, &USART_InitStructure); //初始化串口5
    USART_ITConfig(UART5, USART_IT_RXNE, ENABLE);//开启串口接受中断
    USART_Cmd(UART5, ENABLE);                    //使能串口5                
}

void UART5_SendByte(u8 k)
{
    USART_SendData(UART5, k);//从串口5发送数据
    while(USART_GetFlagStatus(UART5,USART_FLAG_TC)!=SET);//等待发送结束
}

//串口中断,把通讯时伺服返回的数据都存入UART5_RX_BUF数组中
void UART5_IRQHandler(void)
{
    u8 Res;
    if(USART_GetITStatus(UART5, USART_IT_RXNE) != RESET)  //接收中断
    {
        Res =USART_ReceiveData(UART5);//(UART5->DR);    //读取接收到的数据
        UART5_RX_BUF[U5_i]=Res;
        U5_i++;
        if(U5_i>20)
        {U5_i=0;}
    }
}

u32 Get_Posititon(void)//说明手册等待时间须2ms以上
{
    U5_i=0;
    UART5_SendByte(0x05);
    delay_ms(3);
    UART5_SendByte(0x00);
    UART5_SendByte(0x01);
    UART5_SendByte(0xD2);
    UART5_SendByte(0x2D);
    delay_ms(3);
    UART5_SendByte(0x04);
    delay_ms(3);
    UART5_SendByte(0x06);   
    position=(u32)(UART5_RX_BUF[10]+UART5_RX_BUF[11]*0x100+UART5_RX_BUF[12]*0x10000);//单圈绝对值数据
    if((UART5_RX_BUF[0]!=0x04)|(UART5_RX_BUF[1]!=0x06)|(UART5_RX_BUF[2]!=0x05)|(UART5_RX_BUF[3]!=0x0B))
    {
        position = 0x00800000;//错误返回
    }
    U5_i=0;
    return position;
}

各种编码器原理:增量值编码器、单圈绝对值编码器、多圈绝对值编码器

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 218,451评论 6 506
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 93,172评论 3 394
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 164,782评论 0 354
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 58,709评论 1 294
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 67,733评论 6 392
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 51,578评论 1 305
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 40,320评论 3 418
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 39,241评论 0 276
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 45,686评论 1 314
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 37,878评论 3 336
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 39,992评论 1 348
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 35,715评论 5 346
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 41,336评论 3 330
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 31,912评论 0 22
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 33,040评论 1 270
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 48,173评论 3 370
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 44,947评论 2 355

推荐阅读更多精彩内容