C++實(shí)現(xiàn)T型插補(bǔ)詳解
更新時(shí)間：2021年10月29日 08:47:57 作者：(CKK)
這篇文章主要介紹了C++實(shí)現(xiàn)T型插補(bǔ),本文給大家介紹的非常詳細(xì)，對(duì)大家的學(xué)習(xí)或工作具有一定的參考借鑒價(jià)值，需要的朋友可以參考下
Tspeed.h程序
#pragma once #ifndef TSPEED_H #define TSPEED_H #include<iostream> #include<fstream> #include<cmath> using namespace std; void Tspeed(); #endif //TSPEED_H!
Tspeed.cpp程序
#include "Tspeed.h"
ofstream out("Tspeed.txt", ios_base::ate);
void Tspeed()
{
double v0 = 50, v1 = 20, vmax = 150;
double a_add = 1000, a_dec = -1500;
double p0 = 5, p1 = 30;
double t0 = 2;
double h = p1 - p0;
double vf, vv;
double step = 0.001;
vf = sqrt((2 * a_add * a_dec * h - a_add * pow(v1, 2) + a_dec * pow(v0, 2)) / (a_dec - a_add));
if (vf < vmax)
{
vv = vf;
}
else
{
vv = vmax;
}
double Ta, Tv, Td;
double La, Lv, Ld;
Ta = (vv - v0) / a_add;
Tv = (h - (pow(vv, 2) - pow(v0, 2)) / (2 * a_add) - (pow(v1, 2) - pow(vv, 2)) / (2 * a_dec)) / vv;
Td = (v1 - vv) / a_dec;
double t1;
t1 = t0 + Ta + Tv + Td;
La = v0 * Ta + 0.5 * a_add * pow(Ta, 2);
Lv = vv * Tv;
Ld = vv * Td + 0.5 * a_dec * pow(Td, 2);
double p, pd, pdd;
for (double t = 0; t <= Ta + Tv + Td;)
{
if (t >= 0 && t < Ta)
{
p = p0 + v0 * t + 0.5 * a_add * pow(t, 2);
pd = v0 + a_add * t;
pdd = a_add;
}
else if (t >= Ta && t < Ta + Tv)
{
p = p0 + La + vv * (t - Ta);
pd = vv;
pdd = 0;
}
else if (t >= Ta + Tv && t <= Ta + Tv + Td)
{
p = p0 + La + Lv + vv * (t - Ta - Tv) + 0.5 * a_dec * pow((t - Ta - Tv), 2);
pd = vv + a_dec * (t - Ta - Tv);
pdd = a_dec;
}
t = t + step;
double temp = 2;
temp = temp + t;
cout << temp << " " << p << " " << pd << " " << pdd << " " << endl;
out << temp << " " << p << " " << pd << " " << pdd << " " << endl;
//cout << t << endl;
}
out.close();
}
main.cpp程序
#include"Tspeed.h"
int main()
{
Tspeed();
system("pause");
return 0;
}
CMakeLists.txt程序
project(T_CHABU) include_directories(include) add_executable(main_cmake main.cpp src/Tspeed.cpp)
Matlab程序
A=load('Tspeed.txt');
t=A( :,1);
p=A( :,2);
pd=A( :,3);
pdd=A( :,4);
figure(2)
subplot(3, 1, 1)
plot(t, p, 'r', 'LineWidth', 1.5)
ylabel('position')
grid on
subplot(3, 1, 2)
plot(t, pd, 'b', 'LineWidth', 1.5)
ylabel('velocity')
grid on
subplot(3, 1, 3)
plot(t, pdd, 'g', 'LineWidth', 1.5)
ylabel('acceleration')
grid on
總結(jié)
本篇文章就到這里了，希望能夠給你帶來(lái)幫助，也希望您能夠多多關(guān)注腳本之家的更多內(nèi)容！
相關(guān)文章
這篇文章主要介紹了C++取得當(dāng)前時(shí)間的方法,實(shí)例展示了通過(guò)系統(tǒng)函數(shù)獲取當(dāng)前時(shí)間的實(shí)現(xiàn)方法,非常簡(jiǎn)單易懂,需要的朋友可以參考下2014-10-10
C++?OpenCV實(shí)現(xiàn)白平衡之完美反射算法
完美反射算法是白平衡各種算法中較常見的一種，比灰度世界算法更優(yōu)。本文將利用C++和OpenCV實(shí)現(xiàn)白平衡中的完美反射算法，需要的可以參考一下2022-05-05
Boost是為C++語(yǔ)言標(biāo)準(zhǔn)庫(kù)提供擴(kuò)展的一些C++程序庫(kù)的總稱。Boost庫(kù)是一個(gè)可移植、提供源代碼的C++庫(kù)，作為標(biāo)準(zhǔn)庫(kù)的后備，是C++標(biāo)準(zhǔn)化進(jìn)程的開發(fā)引擎之一，是為C++語(yǔ)言標(biāo)準(zhǔn)庫(kù)提供擴(kuò)展的一些C++程序庫(kù)的總稱2022-11-11
Matlab實(shí)現(xiàn)統(tǒng)計(jì)集合中各元素出現(xiàn)次數(shù)的示例代碼
統(tǒng)計(jì)數(shù)組中各個(gè)元素?cái)?shù)量是一個(gè)很常用的功能，本文主要為大家介紹了如何利用Matlab優(yōu)雅的統(tǒng)計(jì)集合中各元素出現(xiàn)的次數(shù)，感興趣的可以了解一下2022-05-05
這篇文章主要介紹了如何編寫C++程序來(lái)使DirectShow進(jìn)行視頻捕捉的方法,DirectShow是微軟公司在ActiveMovie和Video for Windows的基礎(chǔ)上推出的新一代基于COM(Component Object Model)的流媒體處理的開發(fā)包,要的朋友可以參考下
2016-03-03 
OpenCV相機(jī)標(biāo)定的全過(guò)程記錄
這篇文章主要給大家介紹了關(guān)于OpenCV相機(jī)標(biāo)定的相關(guān)資料,文中通過(guò)實(shí)例代碼介紹的非常詳細(xì),對(duì)大家的學(xué)習(xí)或者工作具有一定的參考學(xué)習(xí)價(jià)值,需要的朋友可以參考下
2022-03-03 
詳解C++中的const關(guān)鍵字及與C語(yǔ)言中const的區(qū)別
這篇文章主要介紹了C++中的const關(guān)鍵字及與C語(yǔ)言中const的區(qū)別,const將所修飾的變量對(duì)象轉(zhuǎn)化為常量,需要的朋友可以參考下
2016-04-04 
繼友元知識(shí)過(guò)后，就到了今天的C++運(yùn)算符重載的內(nèi)容了，運(yùn)算符重載是C++里比較重要的內(nèi)容。這篇博文不會(huì)一下子講完各種運(yùn)算符重載，因?yàn)樘嗔肆艘膊缓梦照莆眨赃\(yùn)算符重載我準(zhǔn)備分多次記錄和分享，那么接下來(lái)進(jìn)入正文
2022-11-11 
這篇文章主要介紹了QT5編譯使用QFtp的方法步驟，文中通過(guò)示例代碼介紹的非常詳細(xì)，對(duì)大家的學(xué)習(xí)或者工作具有一定的參考學(xué)習(xí)價(jià)值，需要的朋友們下面隨著小編來(lái)一起學(xué)習(xí)學(xué)習(xí)吧
2021-02-02