差速机器人模型LQR 控制仿真(c++ opencv显示)

server/2024/11/9 17:08:55/

1 差速机器人状态方程构建

1.1差速机器人运动学模型

在这里插入图片描述

1.2模型线性化

在这里插入图片描述

1.3模型离散化

在这里插入图片描述

LQR_12">2离散LQR迭代计算

在这里插入图片描述
注意1：P值的初值为Q。见链接中的：

注意2：Q, R参数调节

注意3：LQR一般只做横向控制，不做纵向控制。LQR输出的速度为速度差，需要进一步转换

3点镇定路径跟踪

通过调整参考路径，实现分段LQR路径跟踪：
①先旋转；
②直线跟踪到目标点；
③再旋转至目标点的姿态；
④再进行目标跟踪。

4代码

https://gitee.com/Luweizhiyuan2020/lqr1.git
注意下载a bit calm这个commit。

5仿真

路径跟踪

在这里插入图片描述

点镇定

在这里插入图片描述

http://www.ppmy.cn/server/40224.html

STM32平衡车-MPU6050的DMP库移植

本文目录一、硬件接线二、需要移植的三个文件夹1. DMP文件夹目录2. IIC文件夹目录3. MPU6050文件夹目录三、文件内容IO12C.cIO12C.hMPU6050.cMPU6050.hmain.c 四、附录1.更改IIC引脚一、硬件接线 SCL-- PA11 SDA-- PA12 VCC-- 3.3v GND-- GND INT-- PC9 二、需要移植的三个…

docker安装的es配置密码认证

docker安装的es配置密码认证前言今天客户提出来，说es的端口是暴露出来的，可以直接取出来数据，按照要求，必须对9200进行密码配置。准备好几种方案，nginx的反向代理加上认证配置（但是是一个单体的服务…

C++中rand()函数和随机数种子

C中rand()函数的用法 rand() % (b-a1) a ; 就表示 a~b 之间的一个随机整数。表达式 int num rand() % 100 1; 产生的是1到100之间的随机数，而不是1到99。 rand() % 100 会产生一个从0到99的随机数，因为 % 是取模运算符，它会给出 rand() …

Android中使用POI库读写Excel（.xlsx/.xls）文件

在Android开发中，处理Excel文件是一项常见需求，无论是从Excel导入数据还是导出数据到Excel。Apache POI是一个强大的Java库，专为操作Microsoft Office文档而设计，它也提供了对Android平台的支持。本文将指导你如何在Android项目中使用Apache POI库来读取和写入Excel文件（包…