国产在线精品欧美日韩电影,久久久网久久久久合久久久久

#include "Speed.h"
//函數(shù)名稱： CalculateSpeedTab
//函數(shù)功能：計(jì)算加減速表
//參數(shù)參數(shù)：Speed 速度結(jié)構(gòu)體
// V0; //初速度，單位：step/s
// Vt; //末速度，單位：step/s
// S; //路程，單位：step
// t; //加速時(shí)間，單位：s
// time; //加速次數(shù) 單位：次
// *SpeedTab; //加速速度表，速度單位：step/s
// SecSpeedPoint; //減速點(diǎn) 單位：step
//返回輸出：速度結(jié)構(gòu)體
static Speed_t CalculateSpeedTab(Speed_t Speed)
{
int i;
double aa; //加加速
int DeltaV; //速度變化量
int tempVt;
//如果速度記錄表的指針為空，說(shuō)明沒(méi)有分配內(nèi)存
RT_ASSERT(Speed->SpeedTab != RT_NULL);
//各參數(shù)是否超范圍
RT_ASSERT(IS_SPEED(Speed->V0, Speed->Vt));
RT_ASSERT(IS_SPACE(Speed->S));
RT_ASSERT(IS_ADDTIMING(Speed->t));
RT_ASSERT(IS_ADDTIME(Speed->time));
//根據(jù)加速法則計(jì)算末速度
tempVt = LASTVELOCITY(Speed->S / SPEEDPRINCIPLE, Speed->V0, Speed->t);
Speed->Vt = (tempVt > Speed->Vt) ? Speed->Vt : tempVt;
Speed->SecSpeedPoint = ACCELERATESPACE(Speed->V0, Speed->Vt, Speed->t); //計(jì)算減速點(diǎn)位置，剩余路程為該值時(shí)開(kāi)始減速
aa = (double)((Speed->Vt - Speed->V0) / 2) //加速度變化拐點(diǎn)時(shí)的速度值 a| /|\
* 2 //知道直角三角形面積，逆推三角型高度時(shí)將面積*2 | / | \面積為DeltaV
/ (Speed->time / 2) //除以底邊 | / | \
/ (Speed->time / 2); //再除以底邊，得到斜率，即加加速 |/___|___\__time
//開(kāi)始速度計(jì)算
for(i = 0; i < ((Speed->time / 2) + 1); i++)
{
DeltaV = (aa * i * i) / 2; //V = V0 + a * t / 2; a = aa * t;
*(Speed->SpeedTab + i) = Speed->V0 + DeltaV; //當(dāng)前點(diǎn)的速度
*(Speed->SpeedTab + Speed->time - i) = Speed->Vt - DeltaV; //對(duì)稱點(diǎn)的速度
}
return Speed;
}
//函數(shù)名稱：TestSpeed
//函數(shù)功能：測(cè)試速度表計(jì)算函數(shù)
//函數(shù)參數(shù)：V0 初速度，單位：轉(zhuǎn)/min
// Vt 末速度，單位：轉(zhuǎn)/min
// S 路程，單位：mm
// time 加速次數(shù)
//函數(shù)返回：無(wú)
void TestSpeed(int V0, int Vt, int S, int time)
{
int i;
Speed_t Speed = (Speed_t)rt_malloc(sizeof(struct SPEED));
Speed->V0 = STEPSPEED(V0); //起速
Speed->Vt = STEPSPEED(Vt); //末速
Speed->S = TOTALSTEP(S); //路程
Speed->t = 0.2; //加速時(shí)間設(shè)為0.2秒
Speed->time = time; //加速次數(shù)
Speed->SpeedTab = (int *)rt_malloc(sizeof(int) * (Speed->time + 1)); //根據(jù)加速次數(shù)申請(qǐng)表格內(nèi)存，加1，以防用的時(shí)候超界
CalculateSpeedTab(Speed); //開(kāi)始計(jì)算
for(i = 0; i < Speed->time; i++)
{
rt_kprintf("SpeedTab[%d] = %d, Acceleration = %d\n"
, i
, *(Speed->SpeedTab + i)
, *(Speed->SpeedTab + i + 1) - *(Speed->SpeedTab + i));
}
rt_kprintf("SpeedTab[%d] = %d\n", i, *(Speed->SpeedTab + i));
rt_free(Speed->SpeedTab);
rt_free(Speed);
}
FINSH_FUNCTION_EXPORT(TestSpeed, Test Speed table calculate);

復(fù)制代碼

#ifndef __SPEED_H__
#define __SPEED_H__
#include "rtthread.h"
#include "finsh.h"
/* 三分之一加減速法則：
加速路程不超過(guò)三分之一總路程，
這樣做的目的是給減速留有足夠的時(shí)間去檢測(cè)減速點(diǎn)，
進(jìn)而實(shí)現(xiàn)平穩(wěn)的將速度減到初速度，
如果在處理速度夠快的情況下，
可以選擇二分之一加減速
*/
//加減速法則，2分之一法則或3分之一法則
#define SPEEDPRINCIPLE 3
//電機(jī)最大轉(zhuǎn)速，單位轉(zhuǎn)/min
#define MOTOMAXSPEED 1500
//電機(jī)每轉(zhuǎn)對(duì)應(yīng)的傳動(dòng)距離,單位：mm
#define MOTOROUNDLENGTH 36
//電機(jī)最大初速度，初速度超過(guò)該值會(huì)對(duì)電機(jī)造成傷害，單位轉(zhuǎn)/min
#define MOTOMAXSTART 200
//驅(qū)動(dòng)器細(xì)分?jǐn)?shù)
#define DRIVERSFRACTION 1
//電機(jī)細(xì)分?jǐn)?shù)
#define MOTOFRACTION 200
//根據(jù)初速度，末速度，以及時(shí)間，計(jì)算加速路程
#define ACCELERATESPACE(V0,Vt,t) (((V0) + (Vt)) * (t) / 2)
//根據(jù)加速路程，初速度，以及時(shí)間，計(jì)算末速度
#define LASTVELOCITY(S,V0,t) (2 * (S) / (t) - (V0))
//根據(jù)電機(jī)轉(zhuǎn)速（轉(zhuǎn)/min），計(jì)算電機(jī)步速度（step/s）
#define STEPSPEED(RV) ((RV) * MOTOFRACTION * DRIVERSFRACTION / 60)
//根據(jù)長(zhǎng)度計(jì)算電機(jī)所需走的步數(shù)，S的單位為mm
#define TOTALSTEP(S) S * MOTOFRACTION * DRIVERSFRACTION / MOTOROUNDLENGTH
struct SPEED
{
int V0; //初速度，單位：step/s
int Vt; //末速度，單位：step/s
long long S; //路程，單位：step
double t; //加速時(shí)間，單位：s
int time; //加速次數(shù) 單位：次
int *SpeedTab; //加速速度表，速度單位：step/s
int SecSpeedPoint; //減速點(diǎn) 單位：step(在電機(jī)運(yùn)動(dòng)過(guò)程中，如果剩余路程小于等于該值，那么電機(jī)開(kāi)始減速)
};
typedef struct SPEED * Speed_t;
//各參數(shù)范圍值，可以在此設(shè)置參數(shù)范圍
//初速度大于0小于電機(jī)最高起速，末速度大于初速度，小于電機(jī)最高轉(zhuǎn)速
#define IS_SPEED(V0,Vt) (((V0) >= 0) && ((V0) <= STEPSPEED(MOTOMAXSTART)) \
&& ((Vt) >= (V0)) && ((Vt) <= STEPSPEED(MOTOMAXSPEED)))
#define IS_SPACE(S) ((S) > 0)
#define IS_ADDTIMING(t) ((t) > 0)
#define IS_ADDTIME(time) ((time) >= 32) //讓加速次數(shù)必須大于等于32，否則計(jì)算表格就沒(méi)什么意義
#endif

復(fù)制代碼