資源簡介
旋轉(zhuǎn)倒立擺源碼,包含自動起擺程序,位置式PID閉環(huán)控制
代碼片段和文件信息
#include?“sys.h“
??/**************************************************************************
作者:平衡小車之家
我的淘寶小店:http://shop114407458.taobao.com/
**************************************************************************/
u8?Flag_Stop=1delay_50delay_flag;?????????//停止標志位?50ms精準演示標志位
int?EncoderPosition_Zero=10000;????????????//編碼器的脈沖計數(shù)
int?Moto;???????????????????????????????????//電機PWM變量?應(yīng)是Motor的?向Moto致敬
int?Voltage;????????????????????????????????//電池電壓采樣相關(guān)的變量
float?Angle_Balance;????????????????????????//角位移傳感器數(shù)據(jù)
float?Balance_KP=50Balance_KD=244Position_KP=25Position_KD=600;??//PID系數(shù)
float?Menu=1Amplitude1=1Amplitude2=10Amplitude3=1Amplitude4=10;?//PID調(diào)試相關(guān)參數(shù)
int?main(void)
{?
Stm32_Clock_Init(9);????????????//=====系統(tǒng)時鐘設(shè)置
delay_init(72);?????????????????//=====延時初始化
JTAG_Set(JTAG_SWD_DISABLE);?????//=====關(guān)閉JTAG接口
JTAG_Set(SWD_ENABLE);????????
- 上一篇:Halcon19.11+20.05安裝包
- 下一篇:蓄電池模型PSCAD建模
評論
共有 條評論