PIBOT下位机开发

1. 概述

  • PIBOT下位机支持多种主板,Arduino Mega2560、STM32F1及STM32F4等
  • PIBOT下位机支持多种运动模型(差分、全向、麦克纳姆轮),无需重新烧写固件即可修改支持
  • PIBOT下位机支持不同的参数的机器人,执行设置相关参数即可

2. 软件框架

软件框架图

橙色部分为下位机的功能模块

3. 下位机开发环境

  • Arduino Mega 2560为主控单元,使用Visual studio code+Platform IO进行开发,支持Windowsubuntu环境
  • STM32F1为主控单元,使用Keil进行开发
  • STM32F4为主控单元,Ubuntu下使用Visual studio code进行开发

3.1 环境搭建

Arduino

具体请参考Visual Studio Code插件PlatformIO IDE开发Arduino

STM32F1

具体请参考PIBOT的STM32F1的环境配置与编译

STM32F4

具体请参考PIBOT的STM32F4环境配置与编译

4. 代码分析

以Arduino为例的代码分析具体请参考ROS机器人底盘(7)-Firmware的代码分析(1)
ROS机器人底盘(8)-Firmware的代码分析(2)
ROS机器人底盘(24)-嵌入式部分框架设计与实现

5. 参数配置

运动参数出厂时都内置在板子的EEPROM/FLASH

set_default_params.gif

5.1 默认参数

默认参数出厂会固化到板子,用户可以根据主机环境校准微调,可以参考PIBOT的控制及校准

pibot_configure.gif

具体参数定义说明如下

  • model_type 模型参数, 具体为2轮差分/三轮全向/麦克纳姆轮

  • wheel_disameter 主动轮的直径

  • wheel_track apollo:两个主动轮的轮间距 zeus:三个轮子所在圆直径 hades:四个轮子矩形长宽之和 hera 左右轮距*系数

  • encoder_resolution 轮子旋转一周编码器变化值的绝对值(一般为4*编码器分辨率,如4 * 11 固件程序做了4倍频)

  • motor_ratio 电机的减速比

  • do_pi_interval 计算pid的间隔时间,固定值10

  • kp ki kd

  • ko 为一个系数,实际P I D参数为kp/ko ki/ko kd/ko

  • cmd_last_time 命令激励的超时时间,即超过该时间没有新的命令会机器人会停止

  • max_v_liner_x max_v_liner_y max_angular_z 底层速度限制,遥控器键盘或者导航层下发的速度会被该值限制

  • imu_type 支持的imu类型

  • motorX_exchange_flag 电机方向调整参数, 具体见下面说明

  • encoderX_exchange_flag 编码器方向调整参数, 具体见下面说明

5.2 电机顺序与电机方向

由于电机批次或者电机型号不一致, 首次接入PIBOT需要做电机顺序的矫正

5.2.1 电机顺序

两轮差分

/*
          x
          ^
          |
          |
          |
y<--------
---------------------
-                   -
-                   -
-                   -
-                   -
-                   -
-                   -
1-------------------2
*/

四轮差分/四轮麦克纳姆轮

/*
          x
          ^
          |
          |
          |
y<--------
3-------------------2
-                   -
-                   -
-                   -
-                   -
-                   -
-                   -
4-------------------1
*/

三轮全向

/*
          x
          ^
          |
          |
          |
y<--------
          1
        -   -
       -     -
      -       -
    -           -
  -               -
 -                 -
2-------------------3
*/

5.2.2 测试电机顺序

  • 确认小车模型
    查看pibot_bringup打印输出,确认当前配置模型是否跟使用的一致,如不一致则host端打开pibot_configure调整

    pibot_confirm_model.gif

  • 测试电机

退出之前的程序, 架空小车(便于观察)

cd ~/pibot_ros/pypibot/transport
# 测试电机1
python test_motors.py 1000 # 命令输完,电机1会转动
# 根据配置的车上对照电机顺序图,观察是否是电机1转动

# 测试电机2
python test_motors.py 0 1000 # 命令输完,电机2会转动
# 根据配置的车上对照电机顺序图,观察是否是电机2转动

# 测试电机3(如果有)
python test_motors.py 0 0 1000 # 命令输完,电机3会转动
# 根据配置的车上对照电机顺序图,观察是否是电机3转动

# 测试电机4(如果有)
python test_motors.py 0 0 1000 # 命令输完,电机4会转动
# 根据配置的车上对照电机顺序图,观察是否是电机4转动
test_motor.gif

5.2.3 电机方向的的确认与调整

确保电机顺序以及方向正常,再测试该项

重做测试电机的测试, 根据输入的参数以及实际转的方向确认电机接线方向是否正确

cd ~/pibot_ros/pypibot/transport
# 测试电机1
python test_motors.py 1000# 命令输完,电机1会转动
# 观察是否是电机1是否顺时针转动(从电机输出轴/外侧观察)
python test_motors.py -1000 0 # 命令输完,电机1会转动
# 观察是否是电机1是否逆时针转动(从电机输出轴/外侧观察)

如果不一致按照之前的在设备端执行pibot_brinup,Host端执行pibot_configure修改motorX_exchange_flag**参数

调整完成主板需要重新上电生效

5.2.4 电机方向的的确认与调整

确保电机顺序以及方向正常,再测试该项

重做测试电机的测试, 根据输入的参数以及编码器的反馈确认编码器

cd ~/pibot_ros/pypibot/transport
# 测试电机1
python test_motors.py 1000 0 # 命令输完,电机1会转动
# 观察输出的日志, 第一列的值是否在变大

python test_motors.py -1000 0 # 命令输完,电机1会转动
# 观察输出的日志, 第一列的值是否在变小

如下结果

  • 在控制电机1顺时针转动时候,编码器1(第一列)逐渐增大则为正常
david@david-MS-7808:~/pibot_ros/pypibot/transport$ python test_motors.py 1000 0
[I] 2021-04-23 23:34:02.941 (0xFBE7):set pwm success
[I] 2021-04-23 23:34:02.941 (0xFBE7):****************get encoder count*****************
[I] 2021-04-23 23:34:02.948 (0xFBE7):encoder count: 0       0       0       0
[I] 2021-04-23 23:34:03.964 (0xFBE7):encoder count: 636.0       0.0     0.0     0.0
[I] 2021-04-23 23:34:04.472 (0xFBE7):encoder count: 1292.0      0.0     0.0     0.0
[I] 2021-04-23 23:34:04.980 (0xFBE7):encoder count: 1949.0      0.0     0.0     0.0
[I] 2021-04-23 23:34:05.488 (0xFBE7):encoder count: 2609.0      0.0     0.0     0.0
[I] 2021-04-23 23:34:05.996 (0xFBE7):encoder count: 3263.0      0.0     0.0     0.0
[I] 2021-04-23 23:34:06.504 (0xFBE7):encoder count: 3922.0      0.0     0.0     0.0
[I] 2021-04-23 23:34:07.012 (0xFBE7):encoder count: 4584.0      0.0     0.0     0.0
  • 在控制电机1逆时针转动时候,编码器1(第一列)逐渐减少则为正常
david@david-MS-7808:~/pibot_ros/pypibot/transport$ python test_motors.py -1000 0
[I] 2021-04-23 23:35:51.575 (0xD657):encoder count: 5402.0      0.0     0.0     0.0
[I] 2021-04-23 23:35:52.083 (0xD657):encoder count: 4772.0      0.0     0.0     0.0
[I] 2021-04-23 23:35:52.591 (0xD657):encoder count: 4122.0      0.0     0.0     0.0
[I] 2021-04-23 23:35:53.099 (0xD657):encoder count: 3473.0      0.0     0.0     0.0
[I] 2021-04-23 23:35:53.607 (0xD657):encoder count: 2822.0      0.0     0.0     0.0

依次控制各个电机,如果符合结果则无需调整,如果某一个或几个不符合则输入下面命令打开配置页面调整对应编码器参数encoderX_exchange_flag

调整完成主板需要重新上电生效

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

推荐阅读更多精彩内容