三轮全向底盘实现绘图功能

最新推荐文章于 2024-02-24 19:30:46 发布
最新推荐文章于 2024-02-24 19:30:46 发布
阅读量637 收藏 5
点赞数 1
文章标签： 机器人 人工智能
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/Robotway/article/details/129840966
版权

1. 功能说明

      本文示例将实现R313a样机三轮全向底盘绘图（三角形、矩形、三叶草、正弦曲线）的功能。三轮全向底盘绘制图形有两种模式：第一种是自主选择模式（即通过按下开关进行模式的选项）；第二种是上位机模式（即通过上位机发送坐标来完成绘制）。这里主要介绍下自主选择模式绘制图形。

2. 结构说明

    R313a样机主要是由R313c样机上安装一个 舵机关节模组 组成。

       三轮全向底盘采用全向福来轮作为执行轮，全向福来轮由主轮和副轮组成，主轮和副轮成垂直分布。三个轮成正三角形分布，两两夹角120度，这种结构使得全向底盘运动灵活、可以在平面内任意方向平移。

三轮全向底盘简图

三轮全向底盘的全向移动需要三个轮之间的相互配合，具体运动方向和各个轮的转向如下图所示：

三轮全向底盘运动简图（横线表示该轮不转，箭头方向为轮转动方向）

3. 三轮全向底盘的运动学逆解分析

我们先做一些必要的前提假设：

① 全向底盘质量分布均匀，每个轮子的大小和质量相同；

② 三个全向轮到中心的距离相等，且两两夹角为120度；

③ 全向底盘不会出现打滑。

     首先建立一个世界坐标系X′O′Y′，然后再建立机器人自身的坐标系XOY。设中心到轮子的距离为常数L，移动平台自身的角速度为ω，设顺时针为角速度正方向，各个轮子的速度分别为Va，Vb，Vc。移动平台在自身坐标系下的分速度为Vx，Vy。夹角 θ₁ = π / 3，θ₂ = π / 6 , α是两个坐标系的夹角。

逆解：

所谓逆解，就是给定一个世界坐标系下的速度矢量，需要求出三个轮子分别需要给多少速度才可以使机器人在世界坐标系下达到该速度矢量。通过简单的速度矢量运算我们可以列出以下的线性方程组：

该线性方程组变成矩阵形式就像下面这样：

 这个解是在机器人自身坐标系下的，当运用到实际场景中还需要一步转换。其实很简单，再乘上一个旋转矩阵就可以了。现在假设我们已经知道 α 的大小了，那么求旋转矩阵就没什么难度了，从X′O′Y′到XOY的旋转矩阵为：

 那么从XOY到X′O′Y′的旋转矩阵就是R(α)的逆矩阵：

 所以有：

 将这个关系代入第一个线性方程中得：

化简得：

4. 电子硬件

本实验中采用了以下硬件：

主控板

STM32主控板

扩展板

STM32扩展板

电池7.4v锂电池
传感器触碰传感器
输出模块OLED显示屏

其它

步进电机、标准舵机

 按下图进行电路连接：舵机连接在PD15引脚上。

 

5. 功能实现

编程环境：keil5

功能：当按上边的触碰传感器时，OLED显示屏上会显示出不同的选项（sin/ Triangle/ Rect/ ThreeLeaf）；当按下边的触碰传感器时，开始绘制相应的内容（见下表）。

参数

绘制的图案

sin

正弦曲线

Triangle

三角形

Rect

矩形

ThreeLeaf

三叶草

三轮全向底盘绘图的参考例程（USER\test.uvprojx）如下，下面是主程序main.c：

/*------------------------------------------------------------------------------------

  版权说明：Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.

           Distributed under MIT license.See file LICENSE for detail or copy at

           https://opensource.org/licenses/MIT

           by 机器谱 2023-03-10 https://www.robotway.com/

  ------------------------------*/

#include "sys.h"

#include "led.h"

#include "usart.h"

#include "delay.h"

#include "math.h"

#include "stdio.h"

#include "string.h"

#include "stdlib.h"

#include "a4988.h"

#include "pwm.h"

#include "key.h"

#include "oled.h"

#include "stdbool.h"


int main(void)

{

NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//设置系统中断优先级分组2

delay_init(168);//初始化延时，168为CPU运行频率

usart_init(9600); //串口初始化

usart3_init(9600);

LED_Init();//LED灯初始化

Stepper_Motor_Init(0); //步进电机引脚初始化

KEY_Init();

OLED_Init(1);

delay_ms(1000);

TIM4_PWM_Init(20000-1,84-1);

Put_Up();delay_ms(1500);

  int receive_touch[2] = {0,0};

bool Flags_draw = false;

OLED_Clear();

OLED_ShowString(30,3,(unsigned char*)"Wait...",16);

while(1)

{

if(touch_keys(1) == 1)

{

  delay_ms(350);

receive_touch[0] += 1;

Flags_draw = false;

}

if(touch_keys(2) == 1)

{

if(Flags_draw)

{

receive_touch[1] = 0;

}

else

{

    delay_ms(350);

  receive_touch[1] = 1;

}

}

  if(receive_touch[0]==1)

{

//printf("data:%d",receive_touch[0]);

  OLED_Clear();

  OLED_ShowString(0,0,(unsigned char*)"Sin",16);

if(receive_touch[1] == 1)

{

OLED_Clear();

OLED_ShowString(0,0,(unsigned char*)"Sin",16);

OLED_ShowString(0,4,(unsigned char*)"Start",16);

receive_touch[1]=0;

delay_ms(1000);

    Put_Down();delay_ms(1000);

    drawSin();

    Put_Up();delay_ms(1000);

}

}

if(receive_touch[0]==2)

{

//printf("data:%d",receive_touch[0]);

  OLED_Clear();

  OLED_ShowString(0,0,(unsigned char*)"Triangle",16);

if(receive_touch[1] == 1)

{

OLED_Clear();

OLED_ShowString(0,0,(unsigned char*)"Triangle",16);

OLED_ShowString(0,4,(unsigned char*)"Start",16);

receive_touch[1]=0;

    Put_Down();delay_ms(1000);

    drawTriangle();

    Put_Up();delay_ms(1000);

}

}



  if(receive_touch[0]==3)

{

//printf("data:%d",receive_touch[0]);

  OLED_Clear();

  OLED_ShowString(0,0,(unsigned char*)"Rect",16);

if(receive_touch[1] == 1)

{

//receive_touch[0]=0;

OLED_Clear();

OLED_ShowString(0,0,(unsigned char*)"Rect",16);

OLED_ShowString(0,4,(unsigned char*)"Start",16);

receive_touch[1]=0;

    Put_Down();delay_ms(1000);

    drawRect();

    Put_Up();delay_ms(1000);

}

}



  if(receive_touch[0]==4)

{

  OLED_Clear();

  OLED_ShowString(0,0,(unsigned char*)"ThreeLeaf",16);

if(receive_touch[1] == 1)

{

OLED_Clear();

OLED_ShowString(0,0,(unsigned char*)"ThreeLeaf",16);

OLED_ShowString(0,4,(unsigned char*)"Start",16);

receive_touch[1]=0;

    //Put_Down();delay_ms(1000);

    drawThreeLeaf();

    Put_Up();delay_ms(1000);

}

}


  if(receive_touch[0]==5)

{

  OLED_Clear();

  OLED_ShowString(8,3,(unsigned char*)"Draw Line End",16);

receive_touch[0]=0;

  receive_touch[1]=0;

  Flags_draw = true;

}

  }

}

三轮全向底盘绘制三角形、矩形、三叶草、正弦曲线的详细例程可下载文末资料获取。

6. 资料下载

三轮全向底盘-绘图

①绘图-例程源代码

②绘图-样机3D文件

资料详见：三轮全向底盘-绘图（STM32）

Robotway
关注
  • 1
    点赞
  • 踩
  • 5
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
三轮全向底盘
chuangfanxing5493的博客
09-22 1964
1.运动学 思路：先考虑机器人在机器人坐标x'oy'下的速度和各轮子线速度的关系，再由绝对坐标和机器人坐标的旋转变换关系得到机器人绝对速度和各电机转速的关系。 全向轮特点：与普通轮最大的不同是一个安装好的全向轮除了可以受控转动，还可以沿轴向自由移动。全向轮除了可以实...
三轮全向底盘：运动学性能分析
花洛兮灬
04-16 5831
速度分析 建立三轮底盘的速度物理学模型如图所示。 其中v_1、v_2、v_3分别为三个轮子的转速，ω为旋转角速度，v_x、v_y为车身坐标系中的速度即相对速度（由于底盘速度性能与在世界坐标系中的姿态无关，因此此处为简化运算，取车身坐标系与世界坐标系X,Y方向重合），a为旋转中心到轮轴心的垂直距离，θ为轮轴与x轴夹角，θ=π/6。不难得出各轮速度的转换矩阵为： ⎡⎣⎢v1v2v3⎤⎦⎥...
STM32三轮全向底盘
weixin_43903002的博客
08-14 2841
STM32三轮全向底盘 最近在实验室培训，玩过麦克纳姆四轮底盘后，玩三轮全向底盘也有一段时间了，于是来分享一下自己的心得。 附图 这是去年参加robocon的底盘，三个大疆3508电机，一个全场定位模块，一个实验室焊的遥控器[^1]: （怕出问题所以没用DEVO10）。 1.底盘公式 三轮全向底盘论坛上已经有很多的前辈写了很多好的文章，自己就不再重复论述了。 附上一篇前辈的博文：https://blog.csdn.net/qq_40696002/article/details/107856908 同样附上视
向梦想出发 - 全向轮移动底盘搭建
youyoujushi2008的博客
09-19 5919
3轮全向移动底盘历程记录
三轮全向轮小车技术报告
最新发布
m0_73577716的博客
02-24 1534
首先我使用IM600姿态传感器来实现对小车姿态角的获取，配置USART6来进行IM600与小车的通讯，main.c中实现通讯的代码如下，其中具体函数的代码可见附件中全向轮小车工程文件中的im948_CMD.h，im948_CMD.c和bsp_usart.h,bsp_usart.c。调试后发现该PS2手柄的摇杆存在严重的漂移现象，无法使用，因此我决定使用四个方向键来控制小车的前后左右的运动，并使用右侧四个按键来调节小车的速度，使用肩键L1,R1来切换小车原地旋转模式和运动模式。有三个输入速度（$v_1 $、
分析总结常见的几种移动机器人底盘类型及其运动学
热门推荐
Skyendless的博客
04-18 3万+
前言（Preface） 最近想做一个关于移动机器人的总结，就先从移动机器人的底盘说起吧。现在移动机器人这么火热，大到无人驾驶车，规矩的有工业上应用得很多的AGV（比如智能物流自动搬运机器人），小到淘宝上面的智能小车，都可以算作移动机器人。移动机器人有各种各样的底盘，有两轮的三轮的四轮的，比如无人车是四轮的阿克曼模型，一般的AGV是两轮差速模型，还有大学生机器人竞赛里面常见的三轮全向轮底盘，四轮全...
ROS——Gazebo仿真——全向轮小车——运动学模型分析
漫长IT路
12-15 1万+
文章目录 #include <cmath> #include <string> #include <ros/ros.h> #include <geometry_msgs/Pose2D.h> #include <sensor_msgs/JointState.h> #in
三轮全向底盘协议v0.21
08-04
三轮全向底盘协议v0.21 三轮全向底盘协议v0.21是基于TCP网络...三轮全向底盘协议v0.21是一个基于TCP网络协议的机器人控制协议，能够实现机器人的速度控制和里程计数据反馈，并且可以根据实际情况进行参数设置和调整。
三轮全向机器人底盘ROS驱动程序
07-24
本文将详细探讨"三轮全向机器人底盘ROS驱动程序"这一主题，涵盖其工作原理、实现方法以及相关的技术要点。 首先，我们要理解什么是三轮全向机器人底盘。与传统的两轮或四轮移动平台不同，三轮全向机器人底盘具有更...
三轮全向轮机器人底盘控制与分析（论文）
06-04
在机器人技术迅速发展的今天,机器人的移动技术也是不断发展的。现有的仿生机器人有...对于全向移动平台,四轮解决方案有麦克纳姆轮移动平台,三轮解决方案有全向轮移动平台等。本文就针对三轮全向轮移动平台进行分析。
1.三轮全向移动底盘运动学解析
ycy_dy的博客
10-26 2万+
三轮图片示意图 2.三轮理解 三轮全向移动底盘因其良好的运动性并且结构简单，近年来备受欢迎。三个轮子互相间隔120°，每个全向轮由若干个小滚轮组成，各个滚轮的母线组成一个完整的圆。机器人既可以沿轮面的切线方向移动，也可以沿轮子的轴线方向移动，这两种运动的组合即可以实现平面内任意方向的运动。 3.运动学分析 为便于运动学分析，我们以理想情况为基础，三个轮子相对于车体的
里程计模型（1）：两轮差分底盘和三轮全向底盘
JasonLi的博客
01-22 4648
对基础的两轮差分底盘和三轮全向底盘进行运动学模型推导。
全向轮三轮小车的搭建（二）
HYXWZ的博客
08-23 1238
这次是第一次搭建全向轮小车，所以选择的是比较简单的树莓派和arduino，一是因为整体上比较简单，二是因为相对于TX2和32来说在价格上要比较经济实惠，特别是对于我这种学生党来说，下面我将我这次搭建用到的硬件整理了一下列了出来。 小车用到的硬件列表 型号 数量 Raspberry Pi 树莓派4B 一块 Arduino Mege2560控制器 一块 MEGA传感器扩展板V2.3 一块 IO传感器扩展板 V7.1 一块 双路15A大功率电机驱动板 两块 4S锂电池 两块
全向轮三轮小车的搭建（一）
HYXWZ的博客
08-20 2921
正值暑假有很多的空余时间，所以打算用自己大一大二所学的知识和一些准备比赛的经验来从零开始搭建一个基于arduino的ros全向轮小车，之前准备比赛做的是差分机器人所以这次想尝试挑战一下全向移动机器人。和其他机器人一样在搭建机器人之前首先得设计好自己机器人的底盘，包括底盘的运动模型，后续都会根据模型去调整小车的一些参数，要想做好一个机器人，搭好底盘是非常重要的一步。 1.全向轮机构设计 全向轮的底盘可以是等边三角形也可以是圆形（可根据自己实际情况来定），三个轮子两两必须相差120°，一般常用的安装方式为三个轮
ROS三轮全向轮移动底盘 (01)
Alvin.Mi
03-26 9942
ROS 三向轮移动底盘硬件 01 简介 在机器人开发中, 首先要设计的就是移动机器人底盘, 需要根据机器人的应用场景来设计符合不同要求的移动底盘。 最为震惊的还是波士顿动力实验室设计的各种移动机器人。 02 差速驱动 差速驱动是一个两轮驱动的系统, 每个轮子都带有独立的执行机构 (如直流电机), 机器人的运动矢量是每个独立车轮运动的总和。对于差速驱动的机器人来说直线运动可能是比较困...
三轮全向移动机器人的控制方法
jyaxp的博客
02-13 1万+
我看过几种三轮全方位轮的控制方法，感觉不好理解，我在这里简单的分享一下我的一种思路。对于场地坐标系的速度Vx,Vy推导到三个轮子的速度一共有两个矩阵公式就能解决。第一个公式，场地坐标系速度Vx,Vy,W转换到机器人坐标系速度vx,vy,w公式：角theta是机器人坐标系的x轴正方向与场地坐标系y轴正方向的夹角，最终theta所带值为与陀螺仪偏航角有关的一个变量。 这个公式推导一下也是很方便的，无论
3轮全向轮正解---41
weixin_34007906的博客
09-14 3306
摘要: 原创博客:转载请标明出处:http://www.cnblogs.com/zxouxuewei/   好长时间没有更新博客了，今天给大家分享福利，三轮的全向轮运动学正解。机器人控制的基础是运动学分析，利用运动学分析，可以得出机器人运动过程中各类参数的变化规律和相互之间的关系， 采用控制系统对这些参数进行控制，才能设计出正确合理的控制系统。 一，首先车轮的安装方式决定了你的运动学模型。...
三轮全向轮底盘SLAM挖坑系列-简介
相信科技的力量
09-13 5318
        写这个系列的博客是为了方便后面学习的同学们方便地搭建起来这么一个平台，然后好基于这个平台做一些有趣的事情，比如测试自己的路径算法，添加各种传感器如陀螺仪、摄像头等等。我个人研究了两年多的SLAM，在这期间踩了很多坑，也收获到很多，希望往后能够继续奋勇向前，攀登技术高峰。         我个人的一些理解，视觉SLAM目前精度还是达不到要求，所以选择这个激光SLAM作为切入口。捣鼓...
stm32三轮全向轮底盘
10-13
首先，您需要选择合适的硬件平台来实现三轮全向轮底盘。STM32是一种常用的微控制器，可以作为底盘的控制器。您需要选择合适的电机和驱动器来控制底盘的运动。 其次，您需要设计合适的控制算法来实现底盘的运动。...
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值