今天給大家安利一下了。一般同學會去某度上搜，看到各種各樣版本的PID示例，或者去GitHub上白嫖。

其實一些芯片公司會提供一些控制領域的解決方案了，這里面就會包括PID庫。

比如ST的“ST Motor Control Sdk”，或者TI的C2000系列的control suite。

不過目前TI官方對于control suite已經不再提供相應的更新，可以繼續下載這個套件。

目前control suite已經更新為C2000WARE-MOTORCONTROL-SDK.

那本文主要介紹TI的control suite，這里面除了PID外有很多控制類算法，并且配置了豐富的文檔。

如何安裝？

進入ti的官網，輸入control suite進行搜索，就可以找到相應的安裝包。

這里有離線安裝包，和在線安裝包。直接基于在線安裝包進行操作即可。我們先下載安裝包。

下面就是一路瘋狂點擊Next即可；

界面 1界面 2界面 3界面 4耐心等待安裝成功

源碼和文檔

進入主界面，這里基本的例子都是基于TI的C2000系列的MCU進行開發的，具體如下圖所示；

主界面

進入主界面之后，我們可以看到左側這邊包含了軟硬件文檔，項目示例還有相應的文檔。

其實我們要找的是基于C2000系列MCU的數學算法庫，可以在下列列表中找到；

當然也可以在安裝目錄C： icontrolSUITElibsapp_libsmotor_controlmath_blocksv4.2下面找到相應的PID算法；

至于如何使用這幾個文件，這里也提供了相應的文檔，在Docs中找到，

例如pid_grando.h文件，這里介紹了對應的平臺，當然是TI系列的MCU，并且依賴于IQMath庫，其實這里我們做一些簡單的改動，就可以移植到自己所需的平臺上去了，具體源碼如下：

/* =================================================================================

File name： PID_GRANDO.H

===================================================================================*/#ifndef __PID_H__#define __PID_H__typedef struct { _iq Ref; // Input： reference set-point

_iq Fbk; // Input： feedback

_iq Out; // Output： controller output

_iq c1; // Internal： derivative filter coefficient 1

_iq c2; // Internal： derivative filter coefficient 2

} PID_TERMINALS;

// note： c1 & c2 placed here to keep structure size under 8 wordstypedef struct { _iq Kr; // Parameter： reference set-point weighting

_iq Kp; // Parameter： proportional loop gain

_iq Ki; // Parameter： integral gain

_iq Kd; // Parameter： derivative gain

_iq Km; // Parameter： derivative weighting

_iq Umax; // Parameter： upper saturation limit

_iq Umin; // Parameter： lower saturation limit

} PID_PARAMETERS;

typedef struct { _iq up; // Data： proportional term

_iq ui; // Data： integral term

_iq ud; // Data： derivative term

_iq v1; // Data： pre-saturated controller output

_iq i1; // Data： integrator storage： ui（k-1）

_iq d1; // Data： differentiator storage： ud（k-1）

_iq d2; // Data： differentiator storage： d2（k-1）

_iq w1; // Data： saturation record： ［u（k-1） - v（k-1）］

} PID_DATA;

typedef struct { PID_TERMINALS term;

PID_PARAMETERS param;

PID_DATA data;

} PID_CONTROLLER;

/*-----------------------------------------------------------------------------

Default initalisation values for the PID objects

-----------------------------------------------------------------------------*/

#define PID_TERM_DEFAULTS {

0，

0，

0，

0，

0

}#define PID_PARAM_DEFAULTS {

_IQ（1.0），

_IQ（1.0），

_IQ（0.0），

_IQ（0.0），

_IQ（1.0），

_IQ（1.0），

_IQ（-1.0）

}#define PID_DATA_DEFAULTS {

_IQ（0.0），

_IQ（0.0），

_IQ（0.0），

_IQ（0.0），

_IQ（0.0），

_IQ（0.0），

_IQ（0.0），

_IQ（1.0）

}/*------------------------------------------------------------------------------

PID Macro Definition

------------------------------------------------------------------------------*/#define PID_MACRO（v）

/* proportional term */

v.data.up = _IQmpy（v.param.Kr， v.term.Ref） - v.term.Fbk;

/* integral term */

v.data.ui = _IQmpy（v.param.Ki， _IQmpy（v.data.w1， （v.term.Ref - v.term.Fbk））） + v.data.i1;

v.data.i1 = v.data.ui;

/* derivative term */

v.data.d2 = _IQmpy（v.param.Kd， _IQmpy（v.term.c1， （_IQmpy（v.term.Ref， v.param.Km） - v.term.Fbk））） - v.data.d2;

v.data.ud = v.data.d2 + v.data.d1;

v.data.d1 = _IQmpy（v.data.ud， v.term.c2）;

/* control output */

v.data.v1 = _IQmpy（v.param.Kp， （v.data.up + v.data.ui + v.data.ud））;

v.term.Out= _IQsat（v.data.v1， v.param.Umax， v.param.Umin）;

v.data.w1 = （v.term.Out == v.data.v1） ？ _IQ（1.0） ： _IQ（0.0）;

#endif // __PID_H__

這里面不僅僅做了積分抗飽和，還有對微分環節的濾波處理，所以應用到項目中是沒有問題的。

代碼中需要了解Q格式的相關的知識，可以參考一下我的這篇文章《一文教你搞懂C語言的Q格式》 ；

另外，這個路徑下的文檔中，還提供了相應的Example，以及PID的信號流圖，具體如下所示：

所以，整體來說，這個部分的源碼以及資料都非常有參考價值，由于離線文件太大，后臺回復【618】獲取相應安裝文件。

原文標題：分享一個直接用于項目開發的PID庫！很好用！

文章出處：【微信公眾號：硬件攻城獅】歡迎添加關注！文章轉載請注明出處。