松下伺服电机多圈绝对值编码器

硬件修改

多圈绝对值功能需要用一个3.6V的电池接到伺服电机编码器上来实现断电保存多圈数据。电池淘宝地址(带安装座)


将电池的正负极接到编码器接口的1、2端,正极和编码器红线对应,负极和编码器桃色线对应。

这里可能需要买金属连接件进行配合→淘宝地址
也可以直接把编码器出线上的红色桃色线剪断,和电池电源线焊上。

清除多圈数据得到初始原点:
把PR15的参数设置为0:
多圈绝对值通讯

STM32主要程序232通讯
u8 UART5_RX_BUF[20];    //接收缓冲,最大20个字节,用于储存编码器位置信息
u8 U5_i=0; 
struct _code
{
    u32 code_value;//编码器值
    u32 cylinder_number;//圈数
    u8 check_bit;//校验位
};

//编码器通讯串口5初始化。伺服驱动默认是9600,可修改pr5.29改变
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=0;//抢占优先级1
    NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;      //子优先级0
    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                
}


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


//串口5中断,把伺服编码器的值返回到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;}
    }
}

//获得圈数和编码值
struct _code Get_Code(void)
{
    struct _code CODE;
    CODE.check_bit = 0;//校验位初始化
    U5_i = 0;
    UART5_SendByte(0x05);
    nopdelay_ms(4);
    UART5_SendByte(0x00);
    UART5_SendByte(0x01);
    UART5_SendByte(0xD2);
    UART5_SendByte(0x2D);
    nopdelay_ms(4);
    UART5_SendByte(0x04);
    nopdelay_ms(4);
    UART5_SendByte(0x06);
    //编码值   
    CODE.code_value = (u32)(UART5_RX_BUF[10]+UART5_RX_BUF[11]*0x100+UART5_RX_BUF[12]*0x10000);//低位+中位*0x100+高位*0x10000
    //圈数
    CODE.cylinder_number = UART5_RX_BUF[13]+UART5_RX_BUF[14]*0x100;
    if(CODE.cylinder_number <= 32767)
        CODE.cylinder_number = CODE.cylinder_number + 65536;//32768~65535为负,65536~98303为正,65536为原点
    
    if((UART5_RX_BUF[0]!=0x04)|(UART5_RX_BUF[1]!=0x06)|(UART5_RX_BUF[2]!=0x05)|(UART5_RX_BUF[3]!=0x0B))
    {
        CODE.code_value = 0x00800000;//读数失败时,返回8388608
        CODE.check_bit = 1;//失败
    }
    U5_i = 0;
    return CODE;
}
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 220,137评论 6 511
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 93,824评论 3 396
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 166,465评论 0 357
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 59,131评论 1 295
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 68,140评论 6 397
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 51,895评论 1 308
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 40,535评论 3 420
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 39,435评论 0 276
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 45,952评论 1 319
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 38,081评论 3 340
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 40,210评论 1 352
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 35,896评论 5 347
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 41,552评论 3 331
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 32,089评论 0 23
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 33,198评论 1 272
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 48,531评论 3 375
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 45,209评论 2 357

推荐阅读更多精彩内容

  • 使用的是伺服驱动X2口的RS232通讯主要是读取伺服电机的单圈绝对值数据。(PS:多圈绝对值需要进行初始清零,和配...
    X_xxieRiemann阅读 11,985评论 2 2
  • 2016-06-18 华杉 舜的大孝,其孝之大,能让全天下都父慈子孝。这就是修身齐家治国平天下的道理。 【孟子曰:...
    郁萍阅读 441评论 0 0
  • 又一次想起你 我们相遇在优美的诗行里, 我蹒跚学步你尽力扶持, 痛苦时你我共同担当, 快乐时你我共同分享。 当我能...
    金赛月阅读 439评论 11 13
  • 筑巢 家里屋檐下,一直都有燕子筑的巢。 冬去春来的时候,大地回暖,春光明好,燕子都会归来。 于是,檐廊间,燕子前后...
    余语于隅阅读 1,131评论 2 10