差分小车模型、单轨模型-matlab画图实现

2023-12-21 07:50

本文主要是介绍差分小车模型、单轨模型-matlab画图实现,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

记得点赞哈。

一、差分小车模型(非完整运动学约束)

1.1 椭圆外部轮子

 代码1

robot_draw(2,6,1,3.1415926/3,'b')
axis equal;function robot_draw(x,y,r,theta,color)
% x y圆心坐标,r圆半径,theta小车行驶角度,color小车颜色
% 调用示例: robot_draw(4,7,1,3.1415926/5,'b')%     figure('visible','off');rectangle('Position',[x-r,y-r,2*r,2*r],'Curvature',[1,1],'LineWidth',1.5,'EdgeColor',color);hold on;x1 = x+1.2*r*cos(theta);y1 = y+1.2*r*sin(theta);line([x,x1],[y,y1],'Color',color,'LineWidth',1.5)hold on;ecc = axes2ecc(r/2,r/8);wheel_left = [x+9*r/8*cos(theta+3.1415926/2), y+9*r/8*sin(theta+3.1415926/2)];[elat,elon]=ellipse1(wheel_left(1),wheel_left(2),[r/2 ecc],rad2deg(theta));line(elat,elon,'Color',color,'LineWidth',1.2);hold on;wheel_right = [x+9*r/8*cos(theta-3.1415926/2), y+9*r/8*sin(theta-3.1415926/2)];[elat,elon]=ellipse1(wheel_right(1),wheel_right(2),[r/2 ecc],rad2deg(theta));line(elat,elon,'Color',color,'LineWidth',1.2);
end

 1.2 长方形内部轮子

 代码2

robot_draw(2,6,1,3.1415926/3,'b')
axis equal;function robot_draw(x,y,r,theta,color)
% x y圆心坐标,r圆半径,theta小车行驶角度,color小车颜色
% 调用示例: robot_draw(4,7,1,3.1415926/5,'b')rectangle('Position',[x-r,y-r,2*r,2*r],'Curvature',[1,1],'LineWidth',1.5,'EdgeColor',color);hold on;x1 = x+1.2*r*cos(theta);y1 = y+1.2*r*sin(theta);line([x,x1],[y,y1],'Color','m','LineWidth',1.5)hold on;L_num = 3*r/5;W_num = r/6;L_wheel = r-2*W_num;%左轮angle_left = theta-3.1415926/2;rot_mat_left = [cos(-angle_left), sin(-angle_left); -sin(-angle_left), cos(-angle_left)];left_up  = rot_mat_left*[-W_num/2-L_wheel;L_num*0.5] + [x;y];left_dw  = rot_mat_left*[-W_num/2-L_wheel;-L_num*0.5] + [x;y];right_up = rot_mat_left*[W_num/2-L_wheel;L_num*0.5] + [x;y];right_dw = rot_mat_left*[W_num/2-L_wheel;-L_num*0.5] + [x;y];hold on;line([left_up(1),right_up(1),right_dw(1),left_dw(1),left_up(1)],[left_up(2),right_up(2),right_dw(2),left_dw(2),left_up(2)],'Color',color,'LineWidth',1.5);hold on;%右轮angle_righ = theta+3.1415926/2;rot_mat_righ = [cos(-angle_righ), sin(-angle_righ); -sin(-angle_righ), cos(-angle_righ)];left_up  = rot_mat_righ*[-W_num/2-L_wheel;L_num*0.5] + [x;y];left_dw  = rot_mat_righ*[-W_num/2-L_wheel;-L_num*0.5] + [x;y];right_up = rot_mat_righ*[W_num/2-L_wheel;L_num*0.5] + [x;y];right_dw = rot_mat_righ*[W_num/2-L_wheel;-L_num*0.5] + [x;y];hold on;line([left_up(1),right_up(1),right_dw(1),left_dw(1),left_up(1)],[left_up(2),right_up(2),right_dw(2),left_dw(2),left_up(2)],'Color',color,'LineWidth',1.5);
end

 二、单轨运动学模型

 代码

robot_draw(4,7,1,3.1415926/6,-3.1415926/5,'b')
axis equal;function h=robot_draw(x,y,r,theta,w,color)
% x y圆心坐标,r圆半径,theta小车行驶角度,w方向盘角度,color小车颜色
% 调用示例: robot_draw(4,7,1,3.1415926/5,'b')theta_n = theta+w;l_car = 0.8*r;rot_mat1 = [cos(-theta), sin(-theta); -sin(-theta), cos(-theta)];p1 = rot_mat1*[l_car; 0] + [x;y];p2 = rot_mat1*[-l_car;0] + [x;y];hold on;h1 = line([p1(1),p2(1)],[p1(2),p2(2)],'Color',color,'LineWidth',1.5);%车前把手angle = theta_n-3.1415926/2;w_car = 3*r/8;rot_mat2 = [cos(-angle), sin(-angle); -sin(-angle), cos(-angle)];p3 = rot_mat2*[-w_car; 0] + p1;p4 = rot_mat2*[ w_car; 0] + p1;hold on;h2 = line([p3(1),p4(1)],[p3(2),p4(2)],'Color',color,'LineWidth',1.5);%后轮L_num = 3*r/5;W_num = r/6;L_wheel = r-2*W_num;angle_left = theta-3.1415926/2;rot_mat_left = [cos(-angle_left), sin(-angle_left); -sin(-angle_left), cos(-angle_left)];left_up  = rot_mat_left*[-W_num/2; L_num*0.5-L_wheel] + [x;y];left_dw  = rot_mat_left*[-W_num/2;-L_num*0.5-L_wheel] + [x;y];right_up = rot_mat_left*[ W_num/2; L_num*0.5-L_wheel] + [x;y];right_dw = rot_mat_left*[ W_num/2;-L_num*0.5-L_wheel] + [x;y];hold on;h3 = line([left_up(1),right_up(1),right_dw(1),left_dw(1),left_up(1)],[left_up(2),right_up(2),right_dw(2),left_dw(2),left_up(2)],'Color',color,'LineWidth',1.5);%前轮L_num = 2*r/5;angle_righ = theta_n+3.1415926/2;rot_mat_righ = [cos(-angle_righ), sin(-angle_righ); -sin(-angle_righ), cos(-angle_righ)];left_up  = rot_mat_righ*[-W_num/2; L_num*0.5] + p1;left_dw  = rot_mat_righ*[-W_num/2;-L_num*0.5] + p1;right_up = rot_mat_righ*[ W_num/2; L_num*0.5] + p1;right_dw = rot_mat_righ*[ W_num/2;-L_num*0.5] + p1;hold on;h4 = line([left_up(1),right_up(1),right_dw(1),left_dw(1),left_up(1)],[left_up(2),right_up(2),right_dw(2),left_dw(2),left_up(2)],'Color',color,'LineWidth',1.5);h = [h1,h2,h3,h4];
end

 理论学习参考 【汽车】【控制】01.01 车辆运动学模型到动力学模型_哔哩哔哩_bilibili

这篇关于差分小车模型、单轨模型-matlab画图实现的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/519156

相关文章

基于Python实现一个图片拆分工具

《基于Python实现一个图片拆分工具》这篇文章主要为大家详细介绍了如何基于Python实现一个图片拆分工具,可以根据需要的行数和列数进行拆分,感兴趣的小伙伴可以跟随小编一起学习一下... 简单介绍先自己选择输入的图片,默认是输出到项目文件夹中,可以自己选择其他的文件夹,选择需要拆分的行数和列数,可以通过

Python中将嵌套列表扁平化的多种实现方法

《Python中将嵌套列表扁平化的多种实现方法》在Python编程中,我们常常会遇到需要将嵌套列表(即列表中包含列表)转换为一个一维的扁平列表的需求,本文将给大家介绍了多种实现这一目标的方法,需要的朋... 目录python中将嵌套列表扁平化的方法技术背景实现步骤1. 使用嵌套列表推导式2. 使用itert

Python使用pip工具实现包自动更新的多种方法

《Python使用pip工具实现包自动更新的多种方法》本文深入探讨了使用Python的pip工具实现包自动更新的各种方法和技术,我们将从基础概念开始,逐步介绍手动更新方法、自动化脚本编写、结合CI/C... 目录1. 背景介绍1.1 目的和范围1.2 预期读者1.3 文档结构概述1.4 术语表1.4.1 核

在Linux中改变echo输出颜色的实现方法

《在Linux中改变echo输出颜色的实现方法》在Linux系统的命令行环境下,为了使输出信息更加清晰、突出,便于用户快速识别和区分不同类型的信息,常常需要改变echo命令的输出颜色,所以本文给大家介... 目python录在linux中改变echo输出颜色的方法技术背景实现步骤使用ANSI转义码使用tpu

Python使用python-can实现合并BLF文件

《Python使用python-can实现合并BLF文件》python-can库是Python生态中专注于CAN总线通信与数据处理的强大工具,本文将使用python-can为BLF文件合并提供高效灵活... 目录一、python-can 库:CAN 数据处理的利器二、BLF 文件合并核心代码解析1. 基础合

Python使用OpenCV实现获取视频时长的小工具

《Python使用OpenCV实现获取视频时长的小工具》在处理视频数据时,获取视频的时长是一项常见且基础的需求,本文将详细介绍如何使用Python和OpenCV获取视频时长,并对每一行代码进行深入解析... 目录一、代码实现二、代码解析1. 导入 OpenCV 库2. 定义获取视频时长的函数3. 打开视频文

golang版本升级如何实现

《golang版本升级如何实现》:本文主要介绍golang版本升级如何实现问题,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录golanwww.chinasem.cng版本升级linux上golang版本升级删除golang旧版本安装golang最新版本总结gola

SpringBoot中SM2公钥加密、私钥解密的实现示例详解

《SpringBoot中SM2公钥加密、私钥解密的实现示例详解》本文介绍了如何在SpringBoot项目中实现SM2公钥加密和私钥解密的功能,通过使用Hutool库和BouncyCastle依赖,简化... 目录一、前言1、加密信息(示例)2、加密结果(示例)二、实现代码1、yml文件配置2、创建SM2工具

Mysql实现范围分区表(新增、删除、重组、查看)

《Mysql实现范围分区表(新增、删除、重组、查看)》MySQL分区表的四种类型(范围、哈希、列表、键值),主要介绍了范围分区的创建、查询、添加、删除及重组织操作,具有一定的参考价值,感兴趣的可以了解... 目录一、mysql分区表分类二、范围分区(Range Partitioning1、新建分区表:2、分

MySQL 定时新增分区的实现示例

《MySQL定时新增分区的实现示例》本文主要介绍了通过存储过程和定时任务实现MySQL分区的自动创建,解决大数据量下手动维护的繁琐问题,具有一定的参考价值,感兴趣的可以了解一下... mysql创建好分区之后,有时候会需要自动创建分区。比如,一些表数据量非常大,有些数据是热点数据,按照日期分区MululbU