久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费
<nav id="emky4"><dl id="emky4"></dl></nav>
<li id="emky4"><input id="emky4"></input></li>
<code id="emky4"><wbr id="emky4"></wbr></code>
標題:
STM32單片機板球系統設計與程序調試 2017國賽資料
[打印本頁]
作者:
guanguandde
時間:
2019-1-5 15:37
標題:
STM32單片機板球系統設計與程序調試 2017國賽資料
在大一參加了2017年的全國大學生電子設計大賽，并且拿到了省賽二等獎，雖然效果不是特別的完美，但是實現了全部的功能。
因為每個點的位置差異，從點到點函數并不只有一種的情況啊
其實總共只有三種點的存在啊
0.png
(180.2 KB, 下載次數: 25)
下載附件
2019-1-5 17:38 上傳
0.png
(43.87 KB, 下載次數: 35)
下載附件
2019-1-5 17:38 上傳
2017年全國大學生電子設計大賽:
/*
1.不同于auto變量，被stati定義的變量的內存只分配一次的，因此在下次調用時仍然保持上次的值，這是一個很重要的功能，
而且也不用每次都開辟內存并寫入相應的數據，為CPU減輕負擔
2.此外，sttic關鍵字限制變量的作用域，只能被模塊內所用函數訪問，但不能被模塊外其他函數訪問
3.自動變量使用堆棧機制使用內存，而靜態變量是分配固定的內存
4.register 請求將數據存到內部寄存器中，不用通過內存尋址來訪問變量，提高訪問效率
5.volatile 從他的內存中讀取數據，而不使用寄存器緩存的值 即不使用寄存器優化
*/
/*typedef unsigned char uchar 對比著看這個你就應該懂啦吧 多多學習這些基礎的東西 以后看別人的代碼就不會太費事啦*/
// printf("count1=%d\r\n",usart2_dat);
u8 item3_flag=0;
u16 time_tingliu;
char cha_x,cha_y;
static uint32_t MoveTimeCnt = 0;
MoveTimeCnt += 5; //每5ms運算1次
if(item3_flag==0)
{
if( (target_BUF[6]<Position_BUF[6]) && (target_BUF[7]<Position_BUF[7]) )
{
target_BUF[6]=Position_BUF[0]+MoveTimeCnt*0.2; //這相當于是一個隨動系統，但不知道那個效果好啊
target_BUF[7]=Position_BUF[1]+MoveTimeCnt*0.2; //到了調試時按照具體的現象定方案吧
}
PID_M1_SetPoint(target_BUF[6]); //X方向PID定位目標值0
PID_M1_SetKp(85);
PID_M1_SetKi(0);
PID_M1_SetKd(2000);
PID_M2_SetPoint(target_BUF[7]); //Y方向PID定位目標值0
PID_M2_SetKp(85);
PID_M2_SetKi(0);
PID_M2_SetKd(2000);
M1.PWM = PID_M1_PosLocCalc(Ball_x); // 電機一PWM計算
M2.PWM = PID_M2_PosLocCalc(Ball_y); // 電機二PWM計算 //但是暫時并沒有使用積分分離，只有積分限幅最后加
if(M1.PWM > POWER1_MAX) M1.PWM = POWER1_MAX;
if(M1.PWM < POWER1_MIN) M1.PWM = POWER1_MIN;
if(M2.PWM > POWER2_MAX) M2.PWM = POWER2_MAX;
if(M2.PWM < POWER2_MIN) M2.PWM = POWER2_MIN;
MotorMove(M1.PWM,M2.PWM);
//這里計算的就是絕對的誤差大小啦
cha_x=Position_BUF[6]-Ball_x;
cha_y=Position_BUF[7]-Ball_y;
if( (abs(cha_x)<4) && (abs(cha_y)<4) )
{
time_tingliu+=5;
if(time_tingliu==420)
{
item3_flag=1;
}
}
}
else //但是要求在P5停留至少兩秒的程序并沒有寫，覺著并不需要 但是時間確實是需要特別注意的一個地方
{
if( (target_BUF[8]<Position_BUF[8]) && (target_BUF[9]<Position_BUF[9]) )
{
target_BUF[8]=Position_BUF[6]+MoveTimeCnt*0.2; //這相當于是一個隨動系統，但不知道那個效果好啊
target_BUF[9]=Position_BUF[7]+MoveTimeCnt*0.2; //到了調試時按照具體的現象定方案吧
}
PID_M1_SetPoint(target_BUF[8]); //X方向PID定位目標值0
PID_M1_SetKp(85);
PID_M1_SetKi(0);
PID_M1_SetKd(2000);
PID_M2_SetPoint(target_BUF[9]); //Y方向PID定位目標值0
PID_M2_SetKp(85);
PID_M2_SetKi(0);
PID_M2_SetKd(2000);
M1.PWM = PID_M1_PosLocCalc(Ball_x); // 電機一PWM計算
M2.PWM = PID_M2_PosLocCalc(Ball_y); // 電機二PWM計算 //但是暫時并沒有使用積分分離，只有積分限幅最后加
if(M1.PWM > POWER1_MAX) M1.PWM = POWER1_MAX;
if(M1.PWM < POWER1_MIN) M1.PWM = POWER1_MIN;
if(M2.PWM > POWER2_MAX) M2.PWM = POWER2_MAX;
if(M2.PWM < POWER2_MIN) M2.PWM = POWER2_MIN;
MotorMove(M1.PWM,M2.PWM);
}
}
/*------------------------------------------
函數功能:第4問PID計算
函數說明:電機M1控制X方向，電機M2控制Y軸方向
------------------------------------------*/
void item4()
{
u8 item4_flag=0;
u16 time_tingliu;
char cha_x,cha_y;
static uint32_t MoveTimeCnt = 0;
MoveTimeCnt += 5; //每5ms運算1次
if(item4_flag==0)
{
if( (target_BUF[8]<Position_BUF[8]) && (target_BUF[9]<Position_BUF[9]) )
{
target_BUF[8]=Position_BUF[0]+MoveTimeCnt*0.2; //這相當于是一個隨動系統，但不知道那個效果好啊
target_BUF[9]=Position_BUF[1]+MoveTimeCnt*0.2; //到了調試時按照具體的現象定方案吧
}
PID_M1_SetPoint(target_BUF[8]); //X方向PID定位目標值0
PID_M1_SetKp(85);
PID_M1_SetKi(0);
PID_M1_SetKd(2000);
PID_M2_SetPoint(target_BUF[9]); //Y方向PID定位目標值0
PID_M2_SetKp(85);
PID_M2_SetKi(0);
PID_M2_SetKd(2000);
M1.PWM = PID_M1_PosLocCalc(Ball_x); // 電機一PWM計算
M2.PWM = PID_M2_PosLocCalc(Ball_y); // 電機二PWM計算 //但是暫時并沒有使用積分分離，只有積分限幅最后加
if(M1.PWM > POWER1_MAX) M1.PWM = POWER1_MAX;
if(M1.PWM < POWER1_MIN) M1.PWM = POWER1_MIN;
if(M2.PWM > POWER2_MAX) M2.PWM = POWER2_MAX;
if(M2.PWM < POWER2_MIN) M2.PWM = POWER2_MIN;
MotorMove(M1.PWM,M2.PWM);
//這里計算的就是絕對的誤差大小啦
//先確定我可以很好的到達區域5，然后再從區域5跑到區域9 在區域1到區域9的途徑很多 我可以隨意選擇的啊
cha_x=Position_BUF[8]-Ball_x;
cha_y=Position_BUF[9]-Ball_y;
if( (abs(cha_x)<4) && (abs(cha_y)<4) )
{
time_tingliu+=5;
if(time_tingliu==100)
{
item4_flag=1;
}
}
}
else
{
if( (target_BUF[16]<Position_BUF[16]) && (target_BUF[17]<Position_BUF[17]) )
{
target_BUF[16]=Position_BUF[8]+MoveTimeCnt*0.2; //這相當于是一個隨動系統，但不知道那個效果好啊
target_BUF[17]=Position_BUF[9]+MoveTimeCnt*0.2; //到了調試時按照具體的現象定方案吧
}
PID_M1_SetPoint(target_BUF[16]); //X方向PID定位目標值0
PID_M1_SetKp(85);
PID_M1_SetKi(0);
PID_M1_SetKd(2000);
PID_M2_SetPoint(target_BUF[17]); //Y方向PID定位目標值0
PID_M2_SetKp(85);
PID_M2_SetKi(0);
PID_M2_SetKd(2000);
M1.PWM = PID_M1_PosLocCalc(Ball_x); // 電機一PWM計算
M2.PWM = PID_M2_PosLocCalc(Ball_y); // 電機二PWM計算 //但是暫時并沒有使用積分分離，只有積分限幅最后加
if(M1.PWM > POWER1_MAX) M1.PWM = POWER1_MAX;
if(M1.PWM < POWER1_MIN) M1.PWM = POWER1_MIN;
if(M2.PWM > POWER2_MAX) M2.PWM = POWER2_MAX;
if(M2.PWM < POWER2_MIN) M2.PWM = POWER2_MIN;
MotorMove(M1.PWM,M2.PWM);
}
5 上下限 0.8-1.2
1題
PID_M1_SetKp(0.07);
PID_M1_SetKi(0);
PID_M1_SetKd(0.8);
PID_M2_SetKp(0.07);
PID_M2_SetKi(0);
PID_M2_SetKd(0.8);
PID_M1_SetPoint(Position_BUF[8]); //X方向PID定位目標值0
PID_M1_SetKp(0.111);
PID_M1_SetKi(0.005);
PID_M1_SetKd(2);
PID_M2_SetPoint(Position_BUF[9]); //Y方向PID跟蹤目標值sin
PID_M2_SetKp(0.111);
PID_M2_SetKi(0.005);
PID_M2_SetKd(2);
2題 PID_M1_SetPoint(Position_BUF[8]); //X方向PID定位目標值0
PID_M1_SetKp(0.22);
PID_M1_SetKi(0.02);
PID_M1_SetKd(1.8);
PID_M2_SetPoint(Position_BUF[9]); //Y方向PID跟蹤目標值sin
PID_M2_SetKp(0.22);
PID_M2_SetKi(0.02);
PID_M2_SetKd(1.8);
void item7()
{
static u8 i;
const float priod =4000; //單擺周期(毫秒) 1851
static uint32_t MoveTimeCnt = 0;
float set_x = 0.0;
float set_y = 0.0;
float Normalization = 0.0;
float Omega = 0.0;
MoveTimeCnt += 100; //每100ms運算1次,來源于100ms的定時器函數
Normalization = (float)MoveTimeCnt / priod; //對單擺周期歸一化
Omega = 2.0*3.1415926*Normalization; //對2π進行歸一化處理
set_x = R*sin(Omega); //計算出X方向當前擺角
set_y = R*sin(Omega+((3.0*3.141592)/2.0)); //計算出Y方向當前擺角 3*PI/2 是順時針轉圈 用正弦余弦就不用這個關系啦
set_x=set_x*4+117;
set_y=set_y*4+116;
PID_M1_SetPoint(set_x); //X方向PID跟蹤目標值sin
PID_M1_SetKp(0.21);
PID_M1_SetKi(0.02);
PID_M1_SetKd(2.01);
PID_M2_SetPoint(set_y); //Y方向PID跟蹤目標值cos
PID_M2_SetKp(0.21);
PID_M2_SetKi(0.02);
PID_M2_SetKd(2.01);
M1.PWM = PID_M1_PosLocCalc(Ball_x); // 電機一PWM計算
M2.PWM = PID_M2_PosLocCalc(Ball_y); // 電機二PWM計算 //但是暫時并沒有使用積分分離，只有積分限幅最后加
if(M1.PWM > POWER1_MAX) M1.PWM = POWER1_MAX;
if(M1.PWM < POWER1_MIN) M1.PWM = POWER1_MIN;
if(M2.PWM > POWER2_MAX) M2.PWM = POWER2_MAX;
if(M2.PWM < POWER2_MIN) M2.PWM = POWER2_MIN; //83 95 107
MotorMove(M1.PWM,M2.PWM);
//作為一個標志，指示系統的運行
i++;
if(i==10)
{
// printf("All is well!\r\n");
// printf("count1=%d\r\n",M1.PWM);
// printf("count2=%d\r\n",M2.PWM);
i=0;
}
send_data(&set_x,&set_y); // 一三目標 二四實
}
下面是主程序:
/**
** 2017全國大學生電子設計大賽
**/
//記得檢查優先級啊，刪減變量 到時候估計PID的選擇也是一個問題啊
/*
比賽記錄：
整個題目全是在要求在X秒之內完成，要停留多少多少秒，可見時間到時候會成為一個很重要的判斷標準
而且可以看出 對小球的快速性要求非常高 誰快誰就是王
*/
#include "sys.h"
int main(void)
{
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //設置系統中斷優先級分組2
NVIC_SetPriority(SysTick_IRQn, NVIC_EncodePriority(5, 0, 0));
All_init();
while(1)
{
}
}
復制代碼
全部資料51hei下載地址：
2017國賽----最后.7z
(617.67 KB, 下載次數: 69)
2019-1-5 17:41 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
歡迎光臨 (http://m.zg4o1577.cn/bbs/)
Powered by Discuz! X3.1
主站蜘蛛池模板：
毛片在线观看视频
|
国产97视频
|
91亚洲精品乱码久久久久久蜜桃
|
日本国产视频
|
欧美网站在线观看
|
精品久久久久久久久久久久久
|
美日韩一区二区三区
|
国产一级在线视频
|
天天操天天看
|
日韩视频在线观看免费
|
激情影院在线观看
|
91蜜桃婷婷狠狠久久综合9色
|
超碰免费在线播放
|
长河落日
|
欧美日韩国产一区二区
|
久久中文视频
|
亚洲国产精品va在线看黑人
|
国产激情在线观看
|
三级在线看
|
特黄一级视频
|
青青草91
|
国产精品一区av
|
中文字幕精品在线观看
|
99精品色
|
www.夜夜骑
|
美女福利视频
|
免费看大片a
|
婷婷第四色
|
综合久久99
|
中文字幕免费在线
|
久久毛片视频
|
国产日韩一区二区
|
91免费看
|
黄色网址在线播放
|
成人久久视频
|
糖心vlog精品一区二区
|
自拍偷拍欧美日韩
|
国产一级二级三级
|
国产九九
|
久久久亚洲一区
|
午夜精品久久久久久久久久蜜桃
|
2017國賽----最后.7z
(617.67 KB, 下載次數: 69)