【速度环+位置环串级PID(大疆M3508减速电机套装】

最新推荐文章于 2024-09-26 19:39:25 发布
最新推荐文章于 2024-09-26 19:39:25 发布
阅读量6.3k 收藏 160
点赞数 13
文章标签： 算法 stm32 单片机
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qq_44915301/article/details/132943365
版权

1.PID介绍

        PID（Proportional-Integral-Derivative）是一种常用的反馈控制算法，广泛应用于自动控制系统中。它是根据目标值和实际值之间的差异（偏差）来调整输出控制信号，使系统能够稳定地接近期望的状态。

        PID控制器由三个部分组成：

  1. 比例（Proportional，P）：比例控制作用于偏差的大小，输出信号与偏差成正比。P部分对应于偏差的大小来产生一个对应的控制量，但无法消除系统的稳态误差。

  2. 积分（Integral，I）：积分控制用于累积偏差，并且与时间成正比。I部分解决了由于比例控制无法消除系统稳态误差而产生的问题。它能够持续地累积偏差，并产生一个反向控制信号，以逐渐消除系统的稳态误差。

  3. 微分（Derivative，D）：微分控制响应偏差的变化率，通过检测偏差的变化趋势来预测未来的偏差。D部分有助于控制系统对于快速变化的偏差作出快速的响应，避免过冲和震荡。

        综合这三个部分，PID的数学如下图所示，e(t)表示当前时刻的误差，PID控制器的输出信号可以表示为以下形式：

        输出信号 = Kp * 偏差 + Ki * ∫(偏差 dt) + Kd * d(偏差)/dt

        其中，Kp、Ki和Kd是称为控制增益的参数，用来调整PID控制器的响应特性。不同的系统需要不同的参数配置，因此，在实际应用中，通常需要进行系统参数调整和优化。
PID原理

        当使用蓄水池来解释PID控制器时，我们可以想象蓄水池的水位需要保持在一个特定的目标水位上。

        蓄水池的水位就相当于控制系统中的状态，而目标水位则是我们希望系统达到的目标状态。PID控制器就像一个智能调节阀门，根据当前水位和目标水位之间的差距，调整阀门的开关程度，以保持水位稳定在目标水位上。

  1. 比例（Proportional）：比例部分会根据当前水位与目标水位之间的差距，决定调整阀门的开关程度。如果水位偏离目标水位很远，比例控制器会适当地打开或关闭阀门，使水位更接近目标水位。

  2. 积分（Integral）：积分部分考虑过去一段时间内水位的累积偏差。如果蓄水池一直没有达到目标水位，积分控制器会累积这些小的水位偏差，并逐渐调整阀门，帮助池水稳步地接近目标水位。

  3. 微分（Derivative）：微分部分关注水位变化的趋势。如果水位接近目标水位时迅速变化，微分控制器会预测这种趋势，并适当调整阀门，以防止水位过冲或下降过快。

        通过比例、积分和微分三个部分的协同作用，PID控制器能够帮助蓄水池维持稳定的水位。无论面对池水剧烈波动或外部影响，PID控制器都会及时作出调整，使蓄水池始终保持在理想的目标水位上。这样，我们可以确保蓄水池在不同条件下都能正常运行，提供稳定的水源供应。
        PID控制器适用于许多自动控制问题，如温度控制、速度控制、位置控制等。它简单、易于实现，是许多工业和工程领域中最常用的控制算法之一。然而，对于某些复杂的系统，PID控制可能不足以满足要求，因此在实际应用中，可能需要使用更高级的控制算法。

1.1位置式PID

        位置式PID（Proportional-Integral-Derivative）是一种常见的反馈控制算法，用于控制系统中。它通过监测系统当前的位置（或状态）与目标位置之间的差异，来调整输出控制信号，使系统尽可能稳定地接近目标位置。让我们详细解释每个组成部分：

  1. 比例（Proportional）部分：比例控制器根据当前位置与目标位置的差异（称为误差），以一定比例来调整输出控制信号。比例增益（通常用字母Kp表示）决定了误差与输出之间的线性关系。如果误差较大，比例控制器会产生更大的调整，以更快地减小误差，但也可能引起过冲现象。

  2. 积分（Integral）部分：积分控制器考虑的是误差随时间的积累。它根据过去的误差累积（称为积分项），以一定比例（积分增益，通常用字母Ki表示）来调整输出控制信号。积分控制器可以消除系统存在的稳态误差（即目标位置与实际位置之间的持续偏差），因为它考虑了误差累积。

  3. 微分（Derivative）部分：微分控制器关注的是误差变化的趋势。它根据当前误差与上次误差的差值，以一定比例（微分增益，通常用字母Kd表示）来调整输出控制信号。微分控制器可以预测误差变化的趋势，从而避免过冲和振荡，提高系统的稳定性。

        位置式PID控制器的输出控制信号可以用以下公式表示：


\text{Output} = Kp \times \text{误差} + Ki \times \text{误差累积} + Kd \times \text{误差变化率}

        在实际应用中，通过调整比例增益（Kp）、积分增益（Ki）和微分增益（Kd），可以使PID控制器达到所需的控制效果。但要注意，过大或过小的增益值可能导致控制系统不稳定或响应过慢。因此，在实际应用中，需要根据系统特性和需求来仔细调整PID参数，以获得最佳的控制效果。

1.2增量式PID

        当解释增量式PID时，我们需要理解其计算方式和与传统位置式PID的区别。下面详细描述增量式PID的工作原理：

  1. 初始设定：

    • 设定目标状态：我们需要指定系统的目标状态，例如目标温度、目标位置等。
    • 初始化增量式PID参数：设定比例增益（Kp）、积分增益（Ki）和微分增益（Kd）。这些参数会影响PID控制器的响应速度、稳定性和精确性。

  2. 系统反馈与误差计算：

    • 测量当前状态：通过传感器或测量装置，获取系统当前的状态值（位置、温度、速度等）。
    • 计算误差：将目标状态减去当前状态，得到当前误差值。

  3. 增量式PID计算：

    • 计算增量比例：将当前误差与上一时刻误差的差值（即增量）乘以比例增益（Kp），得到增量输出中比例部分的贡献。
    • 计算增量积分：将当前误差与上一时刻误差的差值乘以积分增益（Ki），得到增量输出中积分部分的贡献。
    • 计算增量输出：将增量比例和增量积分相加，得到本次的增量输出。

  4. 更新控制信号：

    • 将增量输出与上一时刻的控制信号相加，得到本次的控制信号，用于控制系统。这个控制信号会调整执行器或驱动器，例如改变阀门开度或电机转速，以使系统趋近目标状态。

  5. 循环控制：

    • 控制系统会不断地执行上述步骤，进行反复的测量、误差计算和控制信号更新，以持续调节系统状态，使其稳定在目标状态附近。

        与传统位置式PID相比，增量式PID的主要优势在于计算复杂性的降低和存储资源的节省。因为它只关注误差的变化情况，而不需要保存大量的历史误差数据。这使得增量式PID在资源有限的嵌入式系统或实时控制系统中应用更为方便。然而，由于增量式PID涉及误差的差值，它可能对测量噪声更为敏感，因此在某些情况下可能需要更仔细地调整参数，以获得最佳控制效果。

1.3对比

        位置式PID和增量式PID是两种不同的PID控制算法，它们在计算控制量的方式和特性上有一些区别。以下是它们之间的对比：

  1. 控制量计算方式：

    • 位置式PID：控制量是直接基于当前偏差（目标值与实际输出之间的差异）进行计算，通过比例、积分和微分部分的加权求和来得到输出信号。
    • 增量式PID：控制量是计算当前偏差与过去几个控制周期的偏差之差，通过比例、积分和微分部分的加权求和来得到控制量的增量（变化量），然后将增量累加到输出信号得到最终的控制量。

  2. 积分项处理：

    • 位置式PID：位置式PID中的积分项直接与偏差累积，并可能出现积分饱和问题，导致系统响应不稳定。
    • 增量式PID：增量式PID通过控制量的增量计算，避免了积分饱和问题，因为控制量的增量通常不会累积到较大的值。

  3. 响应特性：

    • 位置式PID：位置式PID可以实现相对较平滑的控制器响应，对于某些系统，可能会有较低的峰值和较小的振荡。
    • 增量式PID：增量式PID对于某些系统可能表现出更为快速的响应特性，因为它直接计算控制量的变化量，可以更快地调整控制器输出。

  4. 控制器集成：

    • 位置式PID：位置式PID相对简单，易于理解和实现。它对于一些简单的控制系统来说已经足够满足要求。
    • 增量式PID：增量式PID更容易与现有的控制器集成，因为它只需要控制量的增量而不需要绝对值。

        在实际应用中，选择使用哪种形式的PID控制算法取决于具体的控制系统要求和性能目标。对于一些简单的系统，位置式PID可能已经足够满足控制要求。而对于一些复杂的系统或需要更高性能控制的应用，增量式PID可能更具优势，因为它可以避免一些位置式PID可能存在的问题，提供更好的控制性能。

2.串级PID

        串级PID（Cascade PID）是一种高级的PID控制结构，用于解决复杂系统的控制问题。它通过将两个或多个PID控制器串联起来，使得一个PID控制器的输出作为另一个PID控制器的输入，从而实现更精确、稳定的控制效果。

        在串级PID控制结构中，通常有两个层级：

  1. 主控制器（外层控制器）：主控制器负责控制系统的主要过程变量，如位置、速度或其他一般的控制目标。它通常使用较慢的控制动作，例如较大的时间常数，来控制整个过程。

  2. 辅助控制器（内层控制器）：辅助控制器负责控制主控制器所需的参考变量。它根据主控制器的输出和实际过程变量之间的差异来计算控制量，然后作为主控制器的设定点（setpoint）。辅助控制器通常具有较快的响应速度，以便更精确地跟踪主控制器的设定点。

        串级PID的工作原理如下：

  1. 主控制器：根据目标设定点和实际过程变量之间的偏差计算主控制器的输出，该输出作为辅助控制器的设定点。

  2. 辅助控制器：根据主控制器的设定点和实际过程变量之间的偏差计算辅助控制器的输出，该输出作为最终的控制信号，用于直接控制系统。

        串级PID控制的优点包括：

  • 提高系统响应速度：由于辅助控制器具有较快的响应特性，能够更快地跟踪主控制器的设定点，从而提高整个系统的响应速度。

  • 减小稳态误差：主控制器负责控制整个过程的稳态误差，而辅助控制器负责校正主控制器的设定点，使得整个系统的稳态误差减小。

  • 改善稳定性：通过两个控制层级的串联，可以在不同时间尺度上进行控制，更好地适应系统的动态特性，从而改善系统的稳定性。

        串级PID控制适用于复杂的控制系统，特别是那些具有多个耦合的过程变量和需要高精度控制的应用。然而，串级PID的设计和调试可能较为复杂，需要深入理解系统的动态特性和控制要求。在实际应用中，需要根据具体的控制需求来选择合适的控制结构和参数配置。

2.1直流无刷电机

大疆M3508电机套装
        此处使用大疆M3508电机套装（P19直流无刷减速电机+C620无刷电机调速器）
相关资料参考：https://www.robomaster.com/zh-CN/products/components/general/M3508
        此处仅列举电机的部分重要参数：
        P19直流无刷减速电机：M3508 直流无刷减速电机是专为中小型移动平台和机器人等量身打造的高性能伺服电机，可搭配 RoboMaster C620 电调实现正弦驱动，相比传统方波驱动具有更高的效率、机动性和稳定性。本产品减速箱减速比约为 19:1。
位置反馈:电机自带位置传感器，可提供位置的反馈
温度检测:电机自带温度检测传感器，可有效防止电机因温度异常被损坏。
信息存储:存储电机校准参数，支持电机的快速更换。
        C620无刷电机调速器：C620 电调采用 32 位定制电机驱动芯片，使用磁场定向控制(FOC) 技术，实现对电机转知的精确控制，与 M3508 直流无刷减速电机搭配，组成强大的动力套件。可配合 RoboMasterAssistant 调参软件进行参数设置并升级固件。
        产品特性：
        支持两种可选控制方式50-500Hz 的 PWM( 脉宽调制）信号控制CAN 总线指令控制
        最高支持 20A 的持续电流支持对 CAN 总线上的电调快速设置 ID支持通过 CAN 总线获取电机温度、转子位置和转了转速等信息
        切换电机时可无需进行位置传感器参数校准
CAN通讯协议
        电调接收报文格式
        用于向电调发送控制指令控制电调的电流输出，两个标识符(0x200 和 0x1FF) 各自对应控制4个ID的电调。控制电流值范围-16384 ~ 0 ~16384，对应电调输出的转矩电流范围-20 ~ 0 ~20A。
标识符: 0x200 帧类型:标准帧 帧格式:DATA DLC:8字节

标识符: 0x1FF 帧类型:标准帧 帧格式:DATA DLC:8字节


电调反馈报文格式

电调向总线上发送的反馈数据。
标识符: 0x200 + 电调ID
(如: ID 为 1，该标识符为 0x201 )帧类型:标准帧帧格式:DATADLC: 8字节

发送频率: 1KHz ( 默认值，可在 RoboMasterAssistant 软件中修改发送频率)

转子机械角度值范围: 0 ~8191

对应转子机械角度为 0~360°

转子转速值的单位为: RPM

电机温度的单位为:°C

2.2电机PID闭环控制

此处的电机PID控制代码参考大疆提供的官方例程，可在网址处下载：M3508减速电机套装 (robomaster.com)

主要用到的文件包括：

pid.h

#ifndef __pid_H
#define __pid_H
/* Includes ------------------------------------------------------------------*/
#include "stm32f4xx_hal.h"

enum{
    LLAST	= 0,
    LAST 	= 1,
    NOW 	= 2,
    
    POSITION_PID,
    DELTA_PID,//PID相关枚举类型
};
typedef struct __pid_t
{
    float p;
    float i;
    float d;
    
    float set[3];				//目标值,包含NOW， LAST， LLAST上上次
    float get[3];				//测量值
    float err[3];				//误差
	
    
    float pout;					//p输出
    float iout;					//i输出
    float dout;					//d输出
    
    float pos_out;				//本次位置式输出
    float last_pos_out;			//上次输出
    float delta_u;				//本次增量值
    float delta_out;			//本次增量式输出 = last_delta_out + delta_u
    float last_delta_out;
    
	float max_err;
	float deadband;				//err < deadband return
    uint32_t pid_mode;
    uint32_t MaxOutput;			//输出限幅
    uint32_t IntegralLimit;		//积分限幅
    
    void (*f_param_init)(struct __pid_t *pid,  //PID参数初始化
                        uint32_t pid_mode,
                        uint32_t maxOutput,
                        uint32_t integralLimit,
                        float p,
                        float i,
                        float d);
    void (*f_pid_reset)(struct __pid_t *pid, float p, float i, float d);//pid三个参数修改
}pid_t;//PID相关结构体定义

void PID_struct_init(
    pid_t* pid,
    uint32_t mode,
    uint32_t maxout,
    uint32_t intergral_limit,
    float 	kp, 
    float 	ki, 
    float 	kd);//初始化函数申明
    
float pid_calc(pid_t* pid, float fdb, float ref);//PID输出值计算
    
extern pid_t pid_rol;
extern pid_t pid_pit;
extern pid_t pid_yaw;
extern pid_t pid_pit_omg;
extern pid_t pid_yaw_omg;	
extern pid_t pid_spd[4];
extern pid_t pid_yaw_alfa;
extern pid_t pid_chassis_angle;
extern pid_t pid_poke;
extern pid_t pid_poke_omg;
extern pid_t pid_imu_tmp;		//imu_temperature
extern pid_t pid_cali_bby;	//big buff yaw
extern pid_t pid_cali_bbp;
extern pid_t pid_omg;
extern pid_t pid_pos;
#endif

头文件中包括PID相关结构体的定义以及用到的函数、变量声明。

pid.c

/* Includes ------------------------------------------------------------------*/
#include "pid.h"
#include "mytype.h"
#include <math.h>

#define ABS(x)		((x>0)? (x): (-x)) 

void abs_limit(float *a, float ABS_MAX)
{
    if(*a > ABS_MAX)
        *a = ABS_MAX;
    if(*a < -ABS_MAX)
        *a = -ABS_MAX;
}
/*参数初始化--------------------------------------------------------------*/
static void pid_param_init
(   pid_t *pid, 
    uint32_t mode,
    uint32_t maxout,
    uint32_t intergral_limit,
    float 	kp, 
    float 	ki, 
    float 	kd)
{
    
    pid->IntegralLimit = intergral_limit;
    pid->MaxOutput = maxout;
    pid->pid_mode = mode;
    
    pid->p = kp;
    pid->i = ki;
    pid->d = kd;
    
}
/*中途更改参数设定(调试)------------------------------------------------------------*/
static void pid_reset(pid_t	*pid, float kp, float ki, float kd)
{
    pid->p = kp;
    pid->i = ki;
    pid->d = kd;
}
/*PID计算（可选择位置式和增量式）----------------------------------------------------*/
float pid_calc(pid_t* pid, float get, float set){
    pid->get[NOW] = get;
    pid->set[NOW] = set;
    pid->err[NOW] = set - get;	//set - measure
    if (pid->max_err != 0 && ABS(pid->err[NOW]) >  pid->max_err  )
		return 0;
	if (pid->deadband != 0 && ABS(pid->err[NOW]) < pid->deadband)
		return 0;
    
    if(pid->pid_mode == POSITION_PID) //位置式p
    {
        pid->pout = pid->p * pid->err[NOW];
        pid->iout += pid->i * pid->err[NOW];
        pid->dout = pid->d * (pid->err[NOW] - pid->err[LAST] );
        abs_limit(&(pid->iout), pid->IntegralLimit);
        pid->pos_out = pid->pout + pid->iout + pid->dout;
        abs_limit(&(pid->pos_out), pid->MaxOutput);
        pid->last_pos_out = pid->pos_out;	//update last time 
    }
    else if(pid->pid_mode == DELTA_PID)//增量式P
    {
        pid->pout = pid->p * (pid->err[NOW] - pid->err[LAST]);
        pid->iout = pid->i * pid->err[NOW];
        pid->dout = pid->d * (pid->err[NOW] - 2*pid->err[LAST] + pid->err[LLAST]);
        
        abs_limit(&(pid->iout), pid->IntegralLimit);
        pid->delta_u = pid->pout + pid->iout + pid->dout;
        pid->delta_out = pid->last_delta_out + pid->delta_u;
        abs_limit(&(pid->delta_out), pid->MaxOutput);
        pid->last_delta_out = pid->delta_out;	//update last time
    }
    
    pid->err[LLAST] = pid->err[LAST];
    pid->err[LAST] = pid->err[NOW];
    pid->get[LLAST] = pid->get[LAST];
    pid->get[LAST] = pid->get[NOW];
    pid->set[LLAST] = pid->set[LAST];
    pid->set[LAST] = pid->set[NOW];
    return pid->pid_mode==POSITION_PID ? pid->pos_out : pid->delta_out;
}

/**
    *@bref. special calculate position PID @attention @use @gyro data!!
    *@param[in] set： target
    *@param[in] real	measure
    */
float pid_sp_calc(pid_t* pid, float get, float set, float gyro){
    pid->get[NOW] = get;
    pid->set[NOW] = set;
    pid->err[NOW] = set - get;	//set - measure
    
    
    if(pid->pid_mode == POSITION_PID) //位置式p
    {
        pid->pout = pid->p * pid->err[NOW];
				if(fabs(pid->i) >= 0.001f)
					pid->iout += pid->i * pid->err[NOW];
				else
					pid->iout = 0;
        pid->dout = -pid->d * gyro/100.0f;	
        abs_limit(&(pid->iout), pid->IntegralLimit);
        pid->pos_out = pid->pout + pid->iout + pid->dout;
        abs_limit(&(pid->pos_out), pid->MaxOutput);
        pid->last_pos_out = pid->pos_out;	//update last time 
    }
    else if(pid->pid_mode == DELTA_PID)//增量式P
    {
        pid->pout = pid->p * (pid->err[NOW] - pid->err[LAST]);
        pid->iout = pid->i * pid->err[NOW];
        pid->dout = pid->d * (pid->err[NOW] - 2*pid->err[LAST] + pid->err[LLAST]);
        
        abs_limit(&(pid->iout), pid->IntegralLimit);
        pid->delta_u = pid->pout + pid->iout + pid->dout;
        pid->delta_out = pid->last_delta_out + pid->delta_u;
        abs_limit(&(pid->delta_out), pid->MaxOutput);
        pid->last_delta_out = pid->delta_out;	//update last time
    }
    
    pid->err[LLAST] = pid->err[LAST];
    pid->err[LAST] = pid->err[NOW];
    pid->get[LLAST] = pid->get[LAST];
    pid->get[LAST] = pid->get[NOW];
    pid->set[LLAST] = pid->set[LAST];
    pid->set[LAST] = pid->set[NOW];
    return pid->pid_mode==POSITION_PID ? pid->pos_out : pid->delta_out;	
}
/*pid总体初始化-----------------------------------------------------------------*/
void PID_struct_init(
    pid_t* pid,
    uint32_t mode,
    uint32_t maxout,
    uint32_t intergral_limit,
    
    float 	kp, 
    float 	ki, 
    float 	kd)
{
    /*init function pointer*/
    pid->f_param_init = pid_param_init;
    pid->f_pid_reset = pid_reset;
	pid->f_cal_pid = pid_calc;	
	pid->f_cal_sp_pid = pid_sp_calc;	//addition
		
    /*init pid param */
    pid->f_param_init(pid, mode, maxout, intergral_limit, kp, ki, kd);
	
}

void pid_test_init(){
	

	//为了解决上位机调参的时候第一次赋值的时候清零其他参数， 应该提前把参数表填充一下！

}

上述文件是PID相关的功能函数，代码中已加入各函数的注释。

pid_t motor_pid_speed[2];				//PID结构体变量定义
PID_struct_init(motor_pid_speed,POSITION_PID,8000,8000,1.5f,0.0f,0.3f);//PID初始化
motor_pid_speed[0].deadband=200;//设置死区
motor_control_val[id]=motor_pid_speed[id].f_cal_pid((motor_pid_speed+id),moto_chassis[id].speed_rpm,motor_target.speed_target[id]);//PID计算
set_moto_current(&hcan,motor_control_val[0],motor_control_val[1],0x0000,0x0000);//发送计算后的电流值

mian函数PID的主要内容包括上述部分：PID结构体变量定义、PID结构体初始化、PID计算、PID结果输出。

2.3速度环+位置环串级PID原理

        因在项目中需要实现速度和位置双环的电机控制，故使用速度环+位置环串级PID控制，下图是控制流程图，参考文章下文已列出：

PID串级控制的典型结构为位置环+速度环+电流环，如下图。

PID串级控制中，最外环是输入是整个控制系统的期望值，外环PID的输出值是内环PID的期望值。

能够使用三环控制的前提是要硬件支持，比如位置环和速度环需要实时的电机转动位置和转动速度作为反馈，这就需要电机需要配有编码器用于测速与测量转动的位置；电流环需要有电流采样电路来实时获取电机的电流作为反馈。

因上文中有单级速度PID的相关程序，串级PID可在其基础之上进行拓展。

pid_t motor_pid_speed[2];			//pid速度环结构体定义
pid_t motor_pid_location[2];		//pid位置环结构体定义

float motor_control_val[2]={0.0};//PID结果输出存储
PID_struct_init(motor_pid_speed,POSITION_PID,8000,8000,1.5f,0.0f,0.3f);//电机1速度环PID结构体初始化
PID_struct_init((motor_pid_speed+1),POSITION_PID,8000,8000,1.5f,0.0f,0.3f);//电机2速度环PID结构体初始化
PID_struct_init(motor_pid_location,POSITION_PID,8000,8000,1.5f,0.0f,0.3f);//电机1位置环PID结构体初始化
PID_struct_init((motor_pid_location+1),POSITION_PID,8000,8000,1.5f,0.0f,0.3f);//电机2位置环PID结构体初始化

motor_pid_speed[0].deadband=200;//电机1速度计算死区
motor_pid_speed[1].deadband=200;//电机2速度计算死区
motor_pid_location[0].deadband=5000;//电机1位置计算死区
motor_pid_location[1].deadband=5000;//电机2位置计算死区

motor_control_val[id]=motor_pid_location[id].f_cal_pid((motor_pid_location+id),moto_chassis[id].total_angle,motor_target.location_target[id]);//根据设定值进行PID计算
if((motor_control_val[id] > motor_target.speed_target[id])&&(motor_target.speed_target[id]>=0))//速度阈值限制
    motor_control_val[id] = motor_target.speed_target[id];
else if((motor_control_val[id] < -motor_target.speed_target[id])&&(motor_target.speed_target[id]>=0))
    motor_control_val[id] = -motor_target.speed_target[id];
else if((motor_control_val[id] < motor_target.speed_target[id])&&(motor_target.speed_target[id]<0))
	motor_control_val[id] = motor_target.speed_target[id];
else if((motor_control_val[id] > -motor_target.speed_target[id])&&(motor_target.speed_target[id]<0))
	motor_control_val[id] = -motor_target.speed_target[id];
motor_control_val[id]=motor_pid_speed[id].f_cal_pid((motor_pid_speed+id),moto_chassis[id].speed_rpm,motor_control_val[id]);//位置环PID计算

set_moto_current(&hcan,motor_control_val[0],motor_control_val[1],0x0000,0x0000);//结果输出

上诉过程中，用到两个电机（项目需要），使用单个电机，自行修改代码即可，此处只做过程展示，在串级PID中，速度环作为内环，位置环作为外环，位置环的PID结果输出值作为内环PID的输入，在输入前，需与速度阈值进行比较，以确保速度环稳定。最后的速度环计算结果作为电流环的输入，由C620电调驱动自行实现。

具体代码可参考：【免费】【速度环+位置环串级PID(大疆M3508减速电机套装】资源-CSDN文库

参考文章网址如下：电机控制进阶3——PID串级控制（附全套代码） - 知乎 (zhihu.com)

会充电的皮卡丘
关注
基于STM32步进电机位置速度双环串级控制
01-12
基于STM32的步进电机控制算法程序，包含位置环和速度环串级双环控制，内有源码，方便大家学习。 基于STM32的步进电机控制算法程序，包含位置环和速度环串级双环控制，内有源码，方便大家学习。
RoboMaster M3508直流无刷减速电机
07-25
RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机RoboMaster M3508直流无刷减速电机
推荐开源项目：RM M3508直流无刷减速电机 + C620无刷电机调速器
最新发布
gitblog_06641的博客
09-26 1116
推荐开源项目：RM M3508直流无刷减速电机 + C620无刷电机调速器 【下载地址】RMM3508直流无刷减速电机C620无刷电机调速器使用说明V1.0 RM M3508直流无刷减速电机 + C620无刷电机调速器 使用说明V1.0 ...
串级PID 位置环+速度环
weixin_62775618的博客
03-28 6260
串级PID 位置环+速度环
大疆M3508电机使用CAN通信进行速度PID闭环控制详解
qq_30267617的博客
08-12 6万+
目录一. 简介二. 电机通信协议三. 电机PID控制原理四. 官方代码移植-中断接收五. 官方代码移植-查询接收 一. 简介 之前写过一篇文章STM32实现四驱小车（五）电机控制任务——电机速度PID控制算法，其中是以大疆的M3508电机为例进行讲解的（没错，就是RoboMaster机器人同款电机，不过Robomaster上的电机好像是小一号的M2006）。不少小伙伴私信问我要代码，我都回复说不是有官方demo么。后来问的人多了我大概明白了，看来官方的Demo还是有点门槛。可能是带FreeRTOS操作系统看
基于大疆RM3508电机的串级PID（角度环＋速度环）
weixin_43903002的博客
11-01 2万+
1.前言 最近参加ROBOCON，我负责编写传球机器人，由于传球机构需要一个电机转固定角度来带动球，所以便用大疆3508电机通过串级PID来实现，不得不说3508电机还是真的强，先看一下效果吧。 视频 2.配置程序 关于3508的配置程序以及一些其他部分在我的另外一篇博客里有详细的介绍，本篇主要是详细讲解3508串级pid（转固定角度）。 大疆3508/2006/6020电机使用教程 3.角度位置控制 3508电机的串级PID控制比起其他直流电机要简单一些，不需要过多的处理编码盘的反馈，只需要读取电调反馈的
大疆M3508电机位置与速度PID控制及自编上位机调参
qq_30267617的博客
10-17 1万+
目录一. 简介 一. 简介 上一篇：大疆M3508电机使用CAN通信进行速度PID闭环控制详解，对官方代码进行了移植，分别使用CAN查询接收与CAN中断接收两种方式实现了电机的速度PID控制，去掉了官方的操作系统，代码精简易读不少。这一篇咱们再接再厉，利用M3508电机实现电机位置控制，同时配合博主编写的上位机软件，实现电机位置、速度的实时显示，通过可视化界面实现电机的PID调参与位置、速度设置。 本文环境： Keil MDK5.14 STM32CubeMX6.2.1 Qt5.14 开发板/芯片：正点原
大疆M3508减速电机套装串级PID控制资源：实现高精度机器人控制
gitblog_09767的博客
09-05 462
大疆M3508减速电机套装串级PID控制资源：实现高精度机器人控制 Hip_Knee_prothese_Control_F1.rar项目地址:https://gitcode.com/open-source-toolkit/d6733 项目介绍 在机器人技术领域，精确的电机控制是实现复杂运动和任务的关键。大疆M3508减速电机套装以其高性能和可靠性，广泛应用于各种机器人项目中。为了帮助开发者更高效...
伺服电机三环（电流环、速度环、位置环）控制原理及参数调节
热门推荐
reason的博客
07-19 11万+
伺服三环控制系统，从内到外依次是电流环、速度环、位置环。
FPGA实现电机位置环、速度环双闭环PID控制
STATEABC的博客
12-05 5225
​位置环作为外环，通过编码器计数通过PID输出速度；位置环输出的速度作为目标速度输入速度环，与编码器测速的当前速度进行PID计算，从而完成电机的双PID控制。​​
双闭环PID程序（位置环加速度环）
07-22
在ＰＩＤ算法中，我们如果只是使用单个闭环ＰＩＤ控制会出现很多的不足。例如我们在单独使用位置环时，在电机未能达到预设位置时，电机的运行状态是１００％ＰＷＭ满偏运行的，这样在我们实际运用时，如果我们使用的电机功率很高就会造成速度过快的现象。所以在电机的控制过程中，最好是多环控制。 在设计过程中，我是不断地尝试得出的结果。最终得出将位置环和速度环的输出叠加的方法，在位置没有到达预设位置时虽然位置环的输出会是满偏，但满偏会让速度出现偏差，速度环就会输出负值反过来抑制总的输出，这样我们就可以在实现位置环的同时也有了速度环的控制。但注意的是在快达到预设位置时需要将速度环关闭。
STM32F7_HAL_CAN_M3508_位置与速度PID_上位机可调参数.zip
10-17
使用STM32F7单片机控制M3508电机实现电机位置控制和速度控制，同时配合本人编写的上位机软件，实现电机位置、速度的实时显示，通过可视化界面实现电机的PID调参与电机模式、位置、速度设置。请配合本人的博客使用，地址：https://blog.csdn.net/qq_30267617/article/details/120764889
RM M3508电机使用说明
01-15
M3508直流无刷减速电机的使用说明，包含中英日三种语言
大疆电机M2006与M3508-PID程序控制-STM32F407ZGT6
08-01
M2006与M3508大疆电机程序控制，开发板型号为STM32F407ZGT6，通过PID控制大疆电机的转速，亲测能用，有问题可以在视频下方留言，视频链接为： https://www.bilibili.com/video/BV1KG411a7os?share_source=copy_web&vd_source=1dde890159cc628cd65fd5b0a4269ef2 CAN控制RM电机__PID控制__大疆C板（付费5r）： http://dt4.8tupian.net/2/31732a6b1.pg0 CAN控制RM电机__PID控制__F407ZGT6 http://dt2.8tupian.net/2/31732a7b1.pg0
can通讯角度串级闭环控制M3508电机.rar
01-04
这篇文档主要介绍的是基于STM32微控制器使用CAN（Controller Area Network）通信协议进行M3508电机的角度串级闭环控制。CAN通信是一种高效、可靠的多主通信网络，广泛应用于汽车电子、工业自动化等领域，这里它被...
10、STM32-F4 直流无刷电机-位置环速度双闭环环串级控制-位置式PID 下位机HAL库源代码
06-20
实现对无刷电机的位置速度双闭环控制 注意,部分例程中,上位机设置PID目标值时,未做幅值限制,若出现积分饱和为正常现象. 在电机未停止时重新开启电机,可能出现PID调整不准确的问题,电机会因为惯性保持运行,定时器会...
基于STM32步进电机位置速度双环串级控制.rar
07-12
在本文中，我们将深入探讨基于STM32微控制器的步进电机控制技术，特别是位置环和速度环双环串级控制。STM32是意法半导体（STMicroelectronics）推出的一种广泛使用的32位微控制器系列，具有高性能、低功耗和丰富的...
【电机控制】小白从零开始：STM32双闭环（速度环、位置环）电机控制（硬件篇）
qq_42681425的博客
04-10 4184
小白从零开始：小程序阿里云平台控制stm32（硬件篇）杭州研究生手把手教你搞不定STM32使用工具：1.PCB设计: 立创EDA+嘉立创2.硬件设备：风枪、焊台、烙铁、焊锡丝、焊带、直流稳压电源、3D打印机、万用表3.硬件外设：stm32f103c8t6主控+蓝牙通讯JDY-33+直流有刷带编码器电机N20+0.96OLED+驱动器L298N+上位机Android设计出来的总体是这样提示：以下是本篇文章正文内容，下面案例可供参考本文仅仅简单介绍了硬件方面，评论区欢迎讨论。
大疆m3508无刷电机程序
07-22
### 回答1： 大疆M3508无刷电机是一款高性能的电机，广泛应用于机器人和无人机领域。其程序是指控制电机运行和控制参数的软件程序。 M3508无刷电机的程序主要包括以下几个方面： 1. 速度控制程序：该程序用于控制电机的转速。通过接收外部的速度指令，将电机转速控制在设定值范围内。同时，该程序还可以配合传感器反馈信息，实现速度闭环控制，保证电机的转速的准确性和稳定性。 2. 位置控制程序：该程序用于控制电机的位置。通过接收外部的位置指令，将电机控制到指定的位置，实现定点定位功能。同样，该程序也可以结合传感器反馈信息，实现位置闭环控制，提高位置控制的精确度和稳定性。 3. 功率控制程序：该程序用于控制电机的功率输出。通过控制电机的电流，调节电机的输出功率，以适应不同工况的需求。同时，该程序还应考虑电机的保护机制，当电机工作过载或工作温度过高时，能及时采取相应的措施，保证电机的安全运行。 4. 通信接口程序：大疆M3508无刷电机还配备了通信接口，可以与外部设备进行数据交互和控制。通过该接口，可以实现与飞行控制器、主控制器等设备的数据传输和命令控制，实现对电机的远程控制和监测。 总之，大疆M3508无刷电机的程序是通过控制电机的速度、位置和功率等参数，实现对电机的精确控制和管理。这些程序能够满足不同应用场景的需求，并保证电机的安全运行和良好的性能表现。 ### 回答2： 大疆m3508无刷电机是一款高性能的电机产品，它具有高转速、高功率和高效率的特点。要编写适用于大疆m3508无刷电机的程序，需要了解一些基本知识和步骤。 首先，编写程序之前需要准备好程序开发环境，比如使用C语言或其他适用的编程语言。接下来，需要了解大疆m3508无刷电机的相关技术规格，比如电机的转速范围、电流范围和控制方式等。 在编写程序之前，需要明确电机的控制目标，比如速度控制、位置控制或者力矩控制。根据控制目标，可以选择相应的控制算法，比如PID控制算法或者模型预测控制算法。 在程序中，需要使用适当的接口和协议与电机进行通信。通常情况下，可以使用PWM信号或者电机驱动芯片来控制电机的转速和转向。同时，还可以通过CAN总线或者UART等通信协议与电机进行数据交互，比如读取电机的转速、电流或者温度等参数。 除了基本的控制功能，还可以通过程序来实现更高级的功能，比如闭环控制、故障检测和保护等。例如，可以通过编写相应的代码来监测电机的过压、过流或者温度过高等异常情况，并及时采取相应的保护措施，以确保电机的安全运行。 总之，编写适用于大疆m3508无刷电机的程序需要掌握相应的技术知识和开发环境，结合电机的技术规格和控制目标，选择合适的控制算法和通信接口，实现电机的控制功能和保护功能。这样才能有效地利用大疆m3508无刷电机的性能，实现所需的各种应用。 ### 回答3： 大疆m3508无刷电机是一种高效、高性能的无刷电机，适用于各种机器人和无人机应用。为了使其正常工作，需要编写程序进行控制。 首先，需要连接m3508无刷电机与控制器。通常，我们可以通过接口线将电机与控制器连接起来，并确保连接稳固可靠。 接下来，编写程序来控制电机。程序需要实现以下功能： 1. 初始化：在开始运行前，需要初始化电机。这包括设置电机参数、设置电机工作模式（例如速度控制或位置控制等）以及设置通信协议和波特率等。 2. 运行控制：根据需要，编写程序来控制电机的运动。可以设置电机转速、位置、加速度等。通过调用控制器提供的函数或方法，可以实现电机的速度控制、位置控制等。 3. 监控状态：在电机运行过程中，需要不断监控其状态，以确保其正常运行。通过读取电机的反馈信息，例如电流、速度、转向等，可以实时监测电机状态。根据实际需要，可以设置报警机制，如超过电机安全工作范围时发出警报。 4. 停止电机：在需要停止电机时，编写程序来实现电机的停止控制。可以通过设置电机的转速为0或者将电机切换到待机模式等方式来停止电机。 最后，通过上述程序的编写，可以实现对大疆m3508无刷电机的控制。根据具体应用需求，可以对程序进行优化和扩展，以实现更复杂的功能和控制策略。
评论 3
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值