weixin_49322998的博客

原创 ROS1消息发布与订阅整理

ros1的消息订阅与发布

原创 18.04ubuntun安装WPSOffice

WPS

原创 滑膜控制和粒子群优化算法

滑膜控制

原创 OSM文件如何打开

OSM文件

原创 纯跟踪算法可借鉴开发

#include "pathcontrol.h"using namespace std;enum StateMachSts_st{ SM_OFF, SM_STANDBY, SM_HANDSHAKE, SM_ACTIVE, SM_BRAKE, SM_COMPLETE,} sm_state;int TargetInd;float Car_current_velicity;bool active;int mini_index;float Lp

转载 坐标系转换-大地坐标转笛卡尔坐标系，笛卡尔坐标系转东北天坐标系

坐标系转换

原创 ROS资源网站收藏

目前ROS2 安装LINK：https://docs.ros.org/en/eloquent/Installation/Linux-Install-Debians.html选择的安装方式Installing ROS 2 via Debian Packages

原创 GPS坐标转换为XYZ坐标

#include <cstdio>#include <cmath>#include <algorithm>#include <iostream>#include <fstream>#include <iomanip>#include <sstream>#include <string>// double wgs84a;// double wgs84b;// double dsq;// dou

原创 C语言状态机Switch-case格式

在#include <stdlib.h>#include <stdio.h>//recorder enum state { s_stop, s_play, s_forward, s_backward, s_pause, s_record };enum message { play, stop, forward, backward, record, pause };void state_change(enum message m){ static enum s

转载 C语言100题之题目

@1.生成不重复的三位数，有1、2、3、4个数字，能组成多少个互不相同且无重复数字的三位数？都是多少？2.企业发放的奖金根据利润提成。利润(I)低于或等于10万元时，奖金可提10%；利润高于10万元，低于20万元时，低于10万元的部分按10%提成，高于10万元的部分，可提成7.5%；20万到40万之间时，高于20万元的部分，可提成5%；40万到60万之间时高于40万元的部分，可提成3%；60万到100万之间时，高于60万元的部分，可提成1.5%；高于100万元时，超过100万元的部分按1%提成。

原创 C语言状态机Switch-case模式

#include <stdlib.h>#include <stdio.h>//recorderenum state { s_stop, s_play, s_forward, s_backward, s_pause, s_record };enum message { play, stop, forward, backward, record, pause };void state_change(enum message m){static enum state s=s

原创 卡尔曼滤波用于自由落体运动目标跟踪问题主要为卡尔曼二维问题

%%%%%%%%%%%%%% 卡尔曼滤波用于自由落体运动目标跟踪问题主要为卡尔曼二维问题%%%%%%%%%%%%%%function mainN=1000; %仿真时间，时间序列总数%噪声Q=[0,0;0,0];%过程噪声方差为0，即下落过程忽略空气阻力R=1; %观测噪声方差W=sqrt(Q)randn(2,N);%既然Q为0，即W=0V=sqrt®randn(1,N);%测量噪声V(k)%系数矩阵A=[1,1;0,1];%状态转移矩阵B=[0.5;1];%控制量U=-1;H=

原创 C语言100题

C语言100题之第一题题目：有1、2、3、4个数字，能组成多少个互不相同且无重复数字的三位数？都是多少？程序分析：可填在百位、十位、个位的数字都是1、2、3、4。组成所有的排列后再去 掉不满足条件的排列。#include<stdio.h>int main(){int i,j,k;printf("\n");for(i=1;i<5;i++) { // 以下为三重循环for(j=1;j<5;j++) {for (k=1;k<5;k++) { // 确保i、j、k三

原创 自动驾驶（三）迪杰斯特拉算法和matlab代码实现

clcclearclose all%%图定义，构建元胞数组nodes_dist = cell(0);nodes_dist(1,:) = {1, [1, 6, 7], [12, 16, 14]};nodes_dist(2,:) = {2, [1, 3, 6], [12, 10, 7]};nodes_dist(3,:) = {3, [2, 4, 5, 6], [10, 3, 5, 6]};nodes_dist(4,:) = {4, [3, 5], [3, 4]};nodes_dist(5,:.

原创 自动驾驶（二）三次多项式和五次多项式路径规划和Matlab代码实现

三次多项式代码实现%example2.6clcclear%轨迹定义条件%时间t0=0;t1=8;%位置和速度（a）q0=0;q1=10;v0=0;v1=0;%利用公式（1-22）求系数h=q1-q0;T=t1-t0;a0=q0;a1=v0;a2=(3h-(2v0+v1)T)/(TT);a3=(-2h+(v0+v1)T)/(TTT);%轨迹生成t=t0:0.1:t1;%位置q=a0+a1power((t-t0),1)+a2power((t-t0),2)+a3po.

原创 卡尔曼滤波室内温度估计

该文章内容出于《卡尔曼滤波原理及应用-Matlab仿真》在网上看了不少与卡尔曼滤波相关的博客、论文，要么是只谈理论、缺乏感性，或者有感性认识，缺乏理论推导。能兼顾二者的少之又少，直到我看到了国外的一篇博文，真的惊艳到我了，不得不佩服作者这种细致入微的精神，翻译过来跟大家分享一下，原文链接：http://www.bzarg.com/p/how-a-kalman-filter-works-in-pictures/CSDN已经被翻译过的链接：https://blog.csdn.net/u010720661/

原创 自动驾驶（1）PID控制