电赛2024年H题智能小车基于MSPM0G3507主控MCU（利用8路灰度加上MPU6050的解决方式）

news2024/11/27 19:48:44

一.前言

        前段时间，激烈的电赛刚刚结束，很荣幸啊，也是十分的不甘心，本次的湖北赛区H题只拿到了一个省二，看最终的排名，在H题中我们离省一也就差几名。但是整个比赛已经过去了，现在不甘与不舍，也没有任何意义了，只有接收这一现实了。

        当时我们整个比赛要求一二三都完美完成，要求四能够十分稳定的跑下来但是跑完四圈得花1分30秒，大概是跑十次才死一两次的样子（毕竟比赛，谁也没办法保证车能够百分百的完美跑完发挥一）。后面也想过提升速度，但是结果都是不尽人意，要么速度提上去了，但是稳定性不强，要么稳定性可以，速度提不上去，最终也来到了四天三夜的最后一天，当时我和另外两个队友商量，觉得稳定还是最主要，所有就抛弃了速度快但是不稳定的所有结果，就留下了最稳定的一个。但是最后直到测试的时候帮我三个人看懵了，看别人武大的发挥一跑完只花了30多秒，当时我们十分紧张的。他们一个发挥一有两个模式，一个是速度慢，但是非常稳定，一个是跑起来不怎么稳定，就车身刚好在线上的那种，但是速度出奇的快。看到这里我三个人直接是慌了，不知道该 这么进行下一步了。

        好在我们三个人十分快速的调制状态，我们 三个人互相鼓励着不管别人怎么样，做好自己就行了，然后我们一项一项的保证每一项最后测试的时候都是一次过的，这也证明我们整个解决方案是十分稳定的。但是今年这个题目光稳定是不够的，或者说是最基础的。最后也十分遗憾的没有拿到省一，只拿了一个省二。

二.具体硬件组成

       本项目由微处理器MSPM0G3507，编码器电机驱动，8路灰度传感器指示线巡线单元，MPU6050六轴传感器无线直行单元，OLED显示人机互动单元，红色LED及蜂鸣器声光提示单元构成。系统运行由两部分组成：自动行驶小车的无指示线直行控制部分和有指示线弯道行驶的实时转向控制部分，小车的无指示线直行控制部分，由MPU6050六轴传感器获得小车姿态的偏航角，通过获得的实时偏航角，编码器的实际值，构成双反馈串行PID实时监控调制小车实际运行轨迹的目的。指示线弯道行驶控制部分，由8路灰度传感器获得小车在指示线上实时运动方位，输出模拟量，通过模拟量和编码器脉冲值构成串行闭环PID实时控制小车投影位于指示线方位的目的。具体的实物图如下：

俯视图

左视图

俯视图

        具体的实物连接图就如上所示了，其实本项目对硬件部分的要求不高，只要能够搭建起来，跑的时候结构稳定，不跑几次容易螺丝松动那种问题，基本就行了，而且本项目对灰度，mpu6050安装的位置不是十分的严格，不管装在那个地方都能够将其做出来的。

三.理论分析部分

        整个项目的准备工作做完之后（硬件搭好了）就开始想着该如何实现，第一个就是有线的时候怎么走？第二个是无线的时候如何走直线？

        首先解决第一个问题：有线的时候直接利用灰度返回的模拟量，得到小车的一个大概位置，也就是偏线的左边还是右边，这样就可以反馈给主控芯片了，主控芯片收到实时反馈之后就要进行处理，也就是用到pid实时调控（如果小车偏左就减少pwm让其回到中心）利用一个10ms定时器去计算实际的小车位置和目标位置（直线的正中心）的差值然后把差值补偿给小车这样就可以达到一个动态平衡的一个状态。也就解决了巡线的理论问题。

        其次就是解决没有线走直线的问题，这个就用到MPU6050陀螺仪了，这里理论上是和上面的一样的，只不过不同的一点是上面利用灰度反射黑线来识别小车的位置，而这里是利用六轴陀螺仪作为参考形成一个闭环串行的pid调制过程。这里实际上只用到一个个轴也就是水平面的x轴，偏航角和其角速度。

        这里两个部分的处理都是有编码器进行速度反馈调制的，也就是第一个环，然后加上后面的两种方式最后就可以达到有线巡线行驶，无线直线行驶。具体的mpu6050和灰度的利用这里就不细讲。

四.代码实现

电机部分

#include "motor.h"
int PWM_MAX =8000;
int PWM_MIN =-8000;

void Limit(int *motoA,int *motoB)
{
	if(*motoA>PWM_MAX)*motoA=PWM_MAX;
	if(*motoA<PWM_MIN)*motoA=PWM_MIN;
	
	if(*motoB>PWM_MAX)*motoB=PWM_MAX;
	if(*motoB<PWM_MIN)*motoB=PWM_MIN;
}

int abs(int p)
{
	int q;
	q=p>0?p:(-p);
	return q;
}

void Load(int moto1,int moto2)
{
	//1.研究正负号，对应正反转
	if(moto1<0)	
    	AIN1_OUT(1),AIN2_OUT(0);//正转
	else 				
    	AIN1_OUT(0),AIN2_OUT(1);//反转
	//2.研究PWM值
	DL_TimerG_setCaptureCompareValue(PWM_A_INST ,abs(moto1),GPIO_PWM_A_C0_IDX);
    if(moto2<0)
    	BIN1_OUT(1),BIN2_OUT(0);
	else 				
    	BIN1_OUT(0),BIN2_OUT(1);	
  	//2.研究PWM值
	DL_TimerG_setCaptureCompareValue(PWM_B_INST ,abs(moto2),GPIO_PWM_B_C0_IDX);
}

pid调制

#include "control.h"

PID_Velocit_TypeDef L_pid, R_pid;
PID_Turn_TypeDef Turn_pid;
void PID_Init(void)
{
L_pid.Kp=80;
L_pid.Kd=0;
L_pid.Ki=0.03;
L_pid.Err=0;
L_pid.Err_Last=0;
L_pid.Integral=0;
L_pid.PID_out=0;
L_pid.Target=0;
R_pid.Kp=75;
R_pid.Kd=0;
R_pid.Ki=0.03;
R_pid.Err=0;
R_pid.Err_Last=0;
R_pid.Integral=0;
R_pid.PID_out=0;
R_pid.Target=0;
}
void PID_turn_Init(PID_Turn_TypeDef *PID)
{
PID->Kp=-5;
PID->Kd=-10;
PID->Ki=0;
PID->Err=0;
PID->Err_Last=0;
PID->Integral=0;
PID->PID_out=0;
PID->Target=0;
}


float pid_Velocity(PID_Velocit_TypeDef *PID,float CurrentValue)
{
    PID->Err =  PID->Target - CurrentValue;
	PID->Integral += PID->Err;  
	/*积分限幅*/
	if(PID->Integral > 2000){PID->Integral = 2000;}
	if(PID->Integral < -2000){PID->Integral = -2000;}    
    PID->PID_out = PID->Kp * PID->Err 										/*比例*/
				 + PID->Ki * PID->Integral  								/*积分*/
			     + PID->Kd * (PID->Err - PID->Err_Last);						/*微分*/
	PID->Err_Last = PID->Err;
    return PID->PID_out;
}

float pid_Turn(PID_Turn_TypeDef *PID,float CurrentValue)
{
    PID->Err =  PID->Target - CurrentValue;
	PID->Integral += PID->Err;  
	/*积分限幅*/
	if(PID->Integral > 2000){PID->Integral = 2000;}
	if(PID->Integral < -2000){PID->Integral = -2000;}    
    PID->PID_out = PID->Kp * PID->Err 										/*比例*/
				 + PID->Ki * PID->Integral  								/*积分*/
			     + PID->Kd * (PID->Err - PID->Err_Last);						/*微分*/
	PID->Err_Last = PID->Err;
    return PID->PID_out;
}
void set_Velocity_Target(PID_Velocit_TypeDef *PID,float target)
{
    PID->Target = target;
}


void set_Turn_Target(PID_Turn_TypeDef *PID,float target)
{
    PID->Target = target;

}

灰度部分

#include "gw.h"
#include "delay.h"



__STATIC_INLINE uint8_t DL_GPIO_readPin(GPIO_Regs* gpio, uint32_t pin)  
{  
    // 假设pin是一个只设置了单个位的位掩码  
    // 检查该引脚在DIN31_0寄存器中是否被设置  
    if (gpio->DIN31_0 & pin) {  
        return 1; // 或 (uint8_t)Bit_SET，如果Bit_SET已定义  
    } else {  
        return 0; // 或 (uint8_t)Bit_RESET，如果Bit_RESET已定义  
    }  
}

uint8_t gw_gray_serial_read(int gpio_clk,int gpio_dat)
{
	uint8_t ret = 0;
	uint8_t i;
	for (i = 0; i < 8; ++i)
	{
		/* 输出时钟下降沿 */
		DL_GPIO_clearPins(SW_SPI_PORT, gpio_clk);
		delay_us(5); //有外部上拉源(4k ~ 10k电阻) 可不加此行
		ret |= DL_GPIO_readPin(SW_SPI_PORT, gpio_dat) << i;
		/* 输出时钟上升沿,让传感器更新数据*/
		 DL_GPIO_setPins(SW_SPI_PORT, gpio_clk);
		/* 延迟需要在5us左右 */
		delay_us(5);
	}
	return ret;
}


void track(void)                           
{
		if(distance==0xe7)        //1110 0111 黑零白一 识别黑线在中央
		{
			
            error=0;
		}
		else if(distance==0xef)   //1110 1111 稍偏右
		{
			
            error=5; 
		}
		else if(distance==0xf7)    //1111 0111 稍偏左
		{
		
            error=-5; 
		}
		else if(distance==0xcf)   //1100 1111 中度偏右
		{
			
            error=10; 
		}
		else if(distance==0xf3)   //1111 0011 中度偏左
		{
			
            error=-10; 
		}
		else if(distance==0xdf)   //1101 1111 高度偏右
		{
			
            error=15;
		}
		else if(distance==0xfb)   //1111 1011 高度偏左
		{
			
            error=-15; 
		}
		else if(distance==0x9f)   //1001 1111  高2度偏右
		{
			
            error=20; 
		}
		else if(distance==0xf9)   //1111 1001  高2度偏左
		{
            
			
            error=-20; 
		}
		else if(distance==0xbf)   //1011 1111  高3度偏右
		{
			
            error=25; 
		}
		else if(distance==0xfd)   //1111 1101  高三度偏左
		{
		
            error=-25; 
		}
		else if(distance==0x3f)   //0011 1111  高4度偏右
		{
		
            error=30; 
		}
		else if(distance==0xfc)   //1111 1100  高4度偏左
		{
		
            error=-30; 
		}
		else if(distance==0x7f)   //0111 1111  高五度偏右
		{
		
            error=35; 
		}	
		else if(distance==0xfd)    //1111 1110  高六度偏左
		{
		
            error=-35; 
		}
		    else if (distance==0xff)                       //0000000  走到终点了
		{
            error=100;
		}
}

mpu6050部分



#include "bsp_mpu6050.h"
#include "stdio.h"
#include "delay.h"
enum I2cControllerStatus {
    I2C_STATUS_IDLE = 0,
    I2C_STATUS_TX_STARTED,
    I2C_STATUS_TX_INPROGRESS,
    I2C_STATUS_TX_COMPLETE,
    I2C_STATUS_RX_STARTED,
    I2C_STATUS_RX_INPROGRESS,
    I2C_STATUS_RX_COMPLETE,
    I2C_STATUS_ERROR,
} gI2cControllerStatus;

uint32_t gTxLen, gTxCount, gRxCount, gRxLen;
uint8_t gTxPacket[128];
uint8_t gRxPacket[128];

char MPU6050_WriteReg(uint8_t addr,uint8_t regaddr,uint8_t num,uint8_t *regdata)
{
    uint16_t i;

    gI2cControllerStatus = I2C_STATUS_IDLE;
    gTxLen = num+1;

    gTxPacket[0] = regaddr;
    for(i=1; i<=num; i++)
    {
        gTxPacket[i] = (uint8_t)regdata[i-1];
    }

    gTxCount = DL_I2C_fillControllerTXFIFO(I2C_MPU6050_INST, &gTxPacket[0], gTxLen);

    if (gTxCount < gTxLen) 
    {
        DL_I2C_enableInterrupt(I2C_MPU6050_INST, DL_I2C_INTERRUPT_CONTROLLER_TXFIFO_TRIGGER);
    } 
    else 
    {
        DL_I2C_disableInterrupt(I2C_MPU6050_INST, DL_I2C_INTERRUPT_CONTROLLER_TXFIFO_TRIGGER);
    }

    gI2cControllerStatus = I2C_STATUS_TX_STARTED;
    while (!(DL_I2C_getControllerStatus(I2C_MPU6050_INST) & DL_I2C_CONTROLLER_STATUS_IDLE));
    DL_I2C_startControllerTransfer(I2C_MPU6050_INST, addr, DL_I2C_CONTROLLER_DIRECTION_TX, gTxLen);

    while ((gI2cControllerStatus != I2C_STATUS_TX_COMPLETE) && (gI2cControllerStatus != I2C_STATUS_ERROR));

    while (DL_I2C_getControllerStatus(I2C_MPU6050_INST) & DL_I2C_CONTROLLER_STATUS_BUSY_BUS);

    while (!(DL_I2C_getControllerStatus(I2C_MPU6050_INST) & DL_I2C_CONTROLLER_STATUS_IDLE));
    delay_cycles(1000);

    return 0;
}

char MPU6050_ReadData(uint8_t addr, uint8_t regaddr,uint8_t num,uint8_t* Read)
{
    uint8_t data[2], i;
    data[0] = regaddr;

    gI2cControllerStatus = I2C_STATUS_IDLE;
    DL_I2C_fillControllerTXFIFO(I2C_MPU6050_INST, &data[0], 1);
    DL_I2C_disableInterrupt(I2C_MPU6050_INST, DL_I2C_INTERRUPT_CONTROLLER_TXFIFO_TRIGGER);
    gI2cControllerStatus = I2C_STATUS_TX_STARTED;
    while (!(DL_I2C_getControllerStatus(I2C_MPU6050_INST) & DL_I2C_CONTROLLER_STATUS_IDLE));
    DL_I2C_startControllerTransfer(I2C_MPU6050_INST, addr, DL_I2C_CONTROLLER_DIRECTION_TX, 1);
    while ((gI2cControllerStatus != I2C_STATUS_TX_COMPLETE) && (gI2cControllerStatus != I2C_STATUS_ERROR));
    while (DL_I2C_getControllerStatus(I2C_MPU6050_INST) & DL_I2C_CONTROLLER_STATUS_BUSY_BUS);

    while (!(DL_I2C_getControllerStatus(I2C_MPU6050_INST) & DL_I2C_CONTROLLER_STATUS_IDLE));
    // delay_cycles(1000);

    gRxLen = num;
    gRxCount = 0;
    gI2cControllerStatus = I2C_STATUS_RX_STARTED;
    DL_I2C_startControllerTransfer(I2C_MPU6050_INST, addr, DL_I2C_CONTROLLER_DIRECTION_RX, gRxLen);
    while (gI2cControllerStatus != I2C_STATUS_RX_COMPLETE);
    while (DL_I2C_getControllerStatus(I2C_MPU6050_INST) &DL_I2C_CONTROLLER_STATUS_BUSY_BUS);

    for(i=0; i<num; i++)
    {
        Read[i] = gRxPacket[i];
    }

    return 0;
}

/******************************************************************
 * 函 数 名 称：MPU_Set_Gyro_Fsr
 * 函 数 说 明：设置MPU6050陀螺仪传感器满量程范围
 * 函 数 形 参：fsr:0,±250dps;1,±500dps;2,±1000dps;3,±2000dps
 * 函 数 返 回：0,设置成功  其他,设置失败
 * 作       者：LC
 * 备       注：无
******************************************************************/
uint8_t MPU_Set_Gyro_Fsr(uint8_t fsr)
{
    uint8_t tmp[2];
    tmp[0] = fsr<<3;
    return MPU6050_WriteReg(0x68,MPU_GYRO_CFG_REG,1,tmp); //设置陀螺仪满量程范围
}    

/******************************************************************
 * 函 数 名 称：MPU_Set_Accel_Fsr
 * 函 数 说 明：设置MPU6050加速度传感器满量程范围
 * 函 数 形 参：fsr:0,±2g;1,±4g;2,±8g;3,±16g
 * 函 数 返 回：0,设置成功  其他,设置失败
 * 作       者：LC
 * 备       注：无
******************************************************************/
uint8_t MPU_Set_Accel_Fsr(uint8_t fsr)
{
    uint8_t tmp[2];
    tmp[0] = fsr<<3;
    return MPU6050_WriteReg(0x68,MPU_ACCEL_CFG_REG,1,tmp); //设置加速度传感器满量程范围  
}

/******************************************************************
 * 函 数 名 称：MPU_Set_LPF
 * 函 数 说 明：设置MPU6050的数字低通滤波器
 * 函 数 形 参：lpf:数字低通滤波频率(Hz)
 * 函 数 返 回：0,设置成功  其他,设置失败
 * 作       者：LC
 * 备       注：无
******************************************************************/
uint8_t MPU_Set_LPF(uint16_t lpf)
{
        uint8_t data=0;
        uint8_t tmp[2];
        
        if(lpf>=188)data=1;
        else if(lpf>=98)data=2;
        else if(lpf>=42)data=3;
        else if(lpf>=20)data=4;
        else if(lpf>=10)data=5;
        else data=6; 
        tmp[0] = data;
    return data=MPU6050_WriteReg(0x68,MPU_CFG_REG,1,tmp);//设置数字低通滤波器  
}
/******************************************************************
 * 函 数 名 称：MPU_Set_Rate
 * 函 数 说 明：设置MPU6050的采样率(假定Fs=1KHz)
 * 函 数 形 参：rate:4~1000(Hz)  初始化中rate取50
 * 函 数 返 回：0,设置成功  其他,设置失败
 * 作       者：LC
 * 备       注：无
******************************************************************/
uint8_t MPU_Set_Rate(uint16_t rate)
{
        uint8_t data;
        uint8_t tmp[2];
        if(rate>1000)rate=1000;
        if(rate<4)rate=4;
        data=1000/rate-1;
        tmp[0] = data;
        data=MPU6050_WriteReg(0x68,MPU_SAMPLE_RATE_REG,1,tmp);        //设置数字低通滤波器
         return MPU_Set_LPF(rate/2);            //自动设置LPF为采样率的一半
}


/******************************************************************
 * 函 数 名 称：MPU6050ReadGyro
 * 函 数 说 明：读取陀螺仪数据
 * 函 数 形 参：陀螺仪数据存储地址 
 * 函 数 返 回：无
 * 作       者：LC
 * 备       注：无
******************************************************************/
void MPU6050ReadGyro(short *gyroData)
{
        uint8_t buf[6];
        uint8_t reg = 0;
        //MPU6050_GYRO_OUT = MPU6050陀螺仪数据寄存器地址
        //陀螺仪数据输出寄存器总共由6个寄存器组成，
        //输出X/Y/Z三个轴的陀螺仪传感器数据，高字节在前，低字节在后。
        //每一个轴16位，按顺序为xyz
        reg = MPU6050_ReadData(0x68,MPU6050_GYRO_OUT,6,buf);
        if( reg == 0 )
        {
                gyroData[0] = (buf[0] << 8) | buf[1];
                gyroData[1] = (buf[2] << 8) | buf[3];
                gyroData[2] = (buf[4] << 8) | buf[5];
        }
}

/******************************************************************
 * 函 数 名 称：MPU6050ReadAcc
 * 函 数 说 明：读取加速度数据
 * 函 数 形 参：加速度数据存储地址 
 * 函 数 返 回：无
 * 作       者：LC
 * 备       注：无
******************************************************************/
void MPU6050ReadAcc(short *accData)
{
        uint8_t buf[6];
        uint8_t reg = 0;
        //MPU6050_ACC_OUT = MPU6050加速度数据寄存器地址
        //加速度传感器数据输出寄存器总共由6个寄存器组成，
        //输出X/Y/Z三个轴的加速度传感器值，高字节在前，低字节在后。
        reg = MPU6050_ReadData(0x68, MPU6050_ACC_OUT, 6, buf);
        if( reg == 0)
        {
                accData[0] = (buf[0] << 8) | buf[1];
                accData[1] = (buf[2] << 8) | buf[3];
                accData[2] = (buf[4] << 8) | buf[5];
        }
}

/******************************************************************
 * 函 数 名 称：MPU6050_GetTemp
 * 函 数 说 明：读取MPU6050上的温度
 * 函 数 形 参：无
 * 函 数 返 回：温度值单位为℃
 * 作       者：LC
 * 备       注：温度换算公式为：Temperature = 36.53 + regval/340
******************************************************************/
float MPU6050_GetTemp(void)
{
        short temp3;
        uint8_t buf[2];
        float Temperature = 0;
        MPU6050_ReadData(0x68,MPU6050_RA_TEMP_OUT_H,2,buf); 
    temp3= (buf[0] << 8) | buf[1];        
        Temperature=((double) temp3/340.0)+36.53;
    return Temperature;
}

/******************************************************************
 * 函 数 名 称：MPU6050ReadID
 * 函 数 说 明：读取MPU6050的器件地址
 * 函 数 形 参：无
 * 函 数 返 回：0=检测不到MPU6050   1=能检测到MPU6050
 * 作       者：LC
 * 备       注：无
******************************************************************/
uint8_t MPU6050ReadID(void)
{
	unsigned char Re[2] = {0};
	//器件ID寄存器 = 0x75
	printf("mpu=%d\r\n",MPU6050_ReadData(0x68,0X75,1,Re)); //读器件地址
	
	if (Re[0] != 0x68) 
	{
			printf("检测不到 MPU6050 模块");
			return 1;
	 } 
	else
	{
			printf("MPU6050 ID = %x\r\n",Re[0]);
			return 0;
	}
	return 0;
}

/******************************************************************
 * 函 数 名 称：MPU6050_Init
 * 函 数 说 明：MPU6050初始化
 * 函 数 形 参：无
 * 函 数 返 回：0成功  1没有检测到MPU6050
 * 作       者：LC
 * 备       注：无
******************************************************************/
char MPU6050_Init(void)
{
    uint8_t tmp[2];

    delay_ms(10);
    //复位6050
    tmp[0] = 0x80;
    MPU6050_WriteReg(0x68,MPU6050_RA_PWR_MGMT_1, 1, tmp);
    delay_ms(100);
    //电源管理寄存器
    //选择X轴陀螺作为参考PLL的时钟源，设置CLKSEL=001
    tmp[0] = 0x00;
    MPU6050_WriteReg(0x68,MPU6050_RA_PWR_MGMT_1,1, tmp);
    
    MPU_Set_Gyro_Fsr(3);    //陀螺仪传感器,±2000dps
    MPU_Set_Accel_Fsr(0);   //加速度传感器,±2g
    MPU_Set_Rate(50);                

    MPU6050_WriteReg(0x68,MPU_INT_EN_REG , 1,tmp);        //关闭所有中断
    MPU6050_WriteReg(0x68,MPU_USER_CTRL_REG,1,tmp);        //I2C主模式关闭
    MPU6050_WriteReg(0x68,MPU_FIFO_EN_REG,1,tmp);                //关闭FIFO
    tmp[0] = 0x80;
    MPU6050_WriteReg(0x68,MPU_INTBP_CFG_REG,1,tmp);        //INT引脚低电平有效
      
    if( MPU6050ReadID() == 0 )//检查是否有6050
    {       
            tmp[0] = 0x01;
            MPU6050_WriteReg(0x68,MPU6050_RA_PWR_MGMT_1, 1,tmp);//设置CLKSEL,PLL X轴为参考
            tmp[0] = 0x00;
            MPU6050_WriteReg(0x68,MPU_PWR_MGMT2_REG, 1,tmp);//加速度与陀螺仪都工作
            MPU_Set_Rate(50);        
            return 1;
    }
    return 0;
}

void I2C_MPU6050_INST_IRQHandler(void)
{
    switch (DL_I2C_getPendingInterrupt(I2C_MPU6050_INST)) {
        case DL_I2C_IIDX_CONTROLLER_RX_DONE:
            gI2cControllerStatus = I2C_STATUS_RX_COMPLETE;
            break;
        case DL_I2C_IIDX_CONTROLLER_TX_DONE:
            DL_I2C_disableInterrupt(
                I2C_MPU6050_INST, DL_I2C_INTERRUPT_CONTROLLER_TXFIFO_TRIGGER);
            gI2cControllerStatus = I2C_STATUS_TX_COMPLETE;
            break;
        case DL_I2C_IIDX_CONTROLLER_RXFIFO_TRIGGER:
            gI2cControllerStatus = I2C_STATUS_RX_INPROGRESS;
            /* Receive all bytes from target */
            while (DL_I2C_isControllerRXFIFOEmpty(I2C_MPU6050_INST) != true) {
                if (gRxCount < gRxLen) {
                    gRxPacket[gRxCount++] =
                        DL_I2C_receiveControllerData(I2C_MPU6050_INST);
                } else {
                    /* Ignore and remove from FIFO if the buffer is full */
                    DL_I2C_receiveControllerData(I2C_MPU6050_INST);
                }
            }
            break;
        case DL_I2C_IIDX_CONTROLLER_TXFIFO_TRIGGER:
            gI2cControllerStatus = I2C_STATUS_TX_INPROGRESS;
            /* Fill TX FIFO with next bytes to send */
            if (gTxCount < gTxLen) {
                gTxCount += DL_I2C_fillControllerTXFIFO(
                    I2C_MPU6050_INST, &gTxPacket[gTxCount], gTxLen - gTxCount);
            }
            break;
            /* Not used for this example */
        case DL_I2C_IIDX_CONTROLLER_ARBITRATION_LOST:
        case DL_I2C_IIDX_CONTROLLER_NACK:
            if ((gI2cControllerStatus == I2C_STATUS_RX_STARTED) ||
                (gI2cControllerStatus == I2C_STATUS_TX_STARTED)) {
                /* NACK interrupt if I2C Target is disconnected */
                gI2cControllerStatus = I2C_STATUS_ERROR;
            }
        case DL_I2C_IIDX_CONTROLLER_RXFIFO_FULL:
        case DL_I2C_IIDX_CONTROLLER_TXFIFO_EMPTY:
        case DL_I2C_IIDX_CONTROLLER_START:
        case DL_I2C_IIDX_CONTROLLER_STOP:
        case DL_I2C_IIDX_CONTROLLER_EVENT1_DMA_DONE:
        case DL_I2C_IIDX_CONTROLLER_EVENT2_DMA_DONE:
        default:
            break;
    }
}

五.总结

        最后我觉得这个项目最重要的部分还是陀螺仪的精准度，如果一个陀螺仪的精准度高，这个项目就十分简单了，像mpu6050这种陀螺仪精准度就稍微差了一点，他有个最严重的问题就是温漂，偏航角会随着温度变化为变化，这一点在跑发挥项一的时候十分关键的，因为这个只差基督就会导致车子跑偏，导致无法完成 整个项目。如果条件足够的话建议可以换一个好一点的陀螺仪，然后就是灰度如果没有条件同样也可以换成红外。以上就是本次项目的一些小建议。

本文来自互联网用户投稿，该文观点仅代表作者本人，不代表本站立场。本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如若转载，请注明出处：http://www.coloradmin.cn/o/2099949.html

如若内容造成侵权/违法违规/事实不符，请联系多彩编程网进行投诉反馈，一经查实，立即删除！

相关文章

浏览器按F12进入开发者模式后频繁因为异常而暂停导致无法分析页面xpath

浏览器按F12进入开发者模式后频繁因为异常而暂停导致无法分析页面xpath

在分析某个内部页面xpath时&#xff0c;遇到一个问题&#xff0c;因为频繁异常而自动暂停导致无法分析页面xpath&#xff0c;如下图&#xff1a; 折腾良久发现把下图右侧的两个抛出异常自动暂停的开关 取消勾选就可以了
阅读更多...
微信小程序接入客服功能

微信小程序接入客服功能

前言 用户可使用小程序客服消息功能&#xff0c;与小程序的客服人员进行沟通。客服功能主要用于在小程序内 用户与客服直接沟通用&#xff0c;本篇介绍客服功能的基础开发以及进阶功能的使用&#xff0c;另外介绍多种客服的对接方式。 更多介绍请查看客服消息使用指南 客服视…
阅读更多...
2.4 堆栈

2.4 堆栈

&#x1f393; 微机原理考点专栏&#xff08;通篇免费&#xff09; 欢迎来到我的微机原理专栏&#xff01;我将帮助你在最短时间内掌握微机原理的核心内容&#xff0c;为你的考研或期末考试保驾护航。 为什么选择我的视频&#xff1f; 全程考点讲解&#xff1a;每一节视频都…
阅读更多...
数据结构——排序【下】

数据结构——排序【下】

目录 一、计数排序 二、快速排序 三、归并排序 四、八大排序时间复杂度及其稳定性 一、计数排序 计数排序是一个非基于比较的排序算法&#xff0c;元素从未排序状态变为已排序状态的过程&#xff0c;是由额外空间的辅助和元素本身的值决定的。该算法于1954年由 Harold H. S…
阅读更多...
Github 2024-09-03 Python开源项目日报 Top10

Github 2024-09-03 Python开源项目日报 Top10

根据Github Trendings的统计，今日(2024-09-03统计)共有10个项目上榜。根据开发语言中项目的数量，汇总情况如下： 开发语言项目数量Python项目10HCL项目1JavaScript项目1Payloads All The Things - 有用的Web应用程序安全负载和绕过列表 创建周期：2639 天开发语言：Python协议…
阅读更多...
Go语言？IDEA能支持吗？增删查走起？

Go语言？IDEA能支持吗？增删查走起？

序&#xff1a; 最近突然身边突然开始冒出关于go语言的只言片语&#xff0c;很好奇这个go语言是怎么样的&#xff1f;这几天有空就会去网上浏览一遍各位大咖的简介。这边主要是已学习为目的&#xff0c;关键人家都说它好这边记录一下学习过程的进坑和爬坑过程供大家娱乐一下。…
阅读更多...
echarts3D地图：旋转、添加纹理图片（vue3）

echarts3D地图：旋转、添加纹理图片（vue3）

首先安装echarts和echarts-gl依赖&#xff0c;注意的是&#xff0c;echarts-gl版本需安装低版本&#xff0c;且与echarts5版本不兼容&#xff0c;需要单独安装4版本&#xff0c;这里我安装的4.2.1版本。 $ npm install echarts4npm:echarts4.2.1 echarts-gl1.1.0npm可以安装ec…
阅读更多...
帧中继了解

帧中继了解

定义 帧中继工作在OSI参考模型的数据链路层&#xff0c;是数据链路层使用简化的方法传送和交换数据单元的一种方式。 帧中继的重要特点之一是将X.25分组交换网中分组节点的差错控制、确认重传、流量控制、拥塞避免等处理过程进行简化&#xff0c;缩短了处理时间&#xff0c;这…
阅读更多...
论文速读|通过人类远程操作的深度模仿学习框架：人型机器人的行走操纵技能

论文速读|通过人类远程操作的深度模仿学习框架：人型机器人的行走操纵技能

项目地址&#xff1a;Deep Imitation Learning for Humanoid Loco-manipulation through Human Teleoperation 本文详细介绍了 TRILL&#xff08;Teleoperation and Imitation Learning for Loco-manipulation&#xff09;框架&#xff0c;它是一个用于人型机器人行走操纵技能训…
阅读更多...
华为OD机试真题 - 中文分词模拟器（Python/JS/C/C++ 2024 D卷 100分）

华为OD机试真题 - 中文分词模拟器（Python/JS/C/C++ 2024 D卷 100分）

华为OD机试 2024E卷题库疯狂收录中&#xff0c;刷题点这里 专栏导读 本专栏收录于《华为OD机试真题&#xff08;Python/JS/C/C&#xff09;》。 刷的越多&#xff0c;抽中的概率越大&#xff0c;私信哪吒&#xff0c;备注华为OD&#xff0c;加入华为OD刷题交流群&#xff0c;…
阅读更多...
Spark-Yarn模式如何配置历史服务器

Spark-Yarn模式如何配置历史服务器

在Spark程序结束之后我们也想看到运行过程怎么办&#xff1f; Yarn模式下&#xff0c;通过以下步骤配置历史服务器即可: mv spark-defaults.conf.template spark-defaults.conf修改spark-default.conf 文件&#xff0c;配置日志存储路径 spark.eventLog.enabled true spark.…
阅读更多...
pg小版本升级

pg小版本升级

文章目录 一、升级计划二、升级步骤1、安装目标版本数据库2、停止数据库实例3、备份数据目录4、调整环境变量&#xff0c;PGHOME/LD_LIRARAY_PATH5、使用新版本启动数据库 三、检查升级后的数据库 一、升级计划 pg14.0 -> pg14.9 查看当前版本信息&#xff1a; select ve…
阅读更多...
24 - 第三方库的使用支持

24 - 第三方库的使用支持

---- 整理自狄泰软件唐佐林老师课程 文章目录 1. 第三方库的使用支持1.1 问题1.2 经验假设1.3 第三方库在项目中的位置 2. 第三方库的编译阶段支持3. 第三方库的链接阶段支持4. 实验 1. 第三方库的使用支持 1.1 问题 当需要使用第三方库文件时&#xff0c;编译环境中的 makef…
阅读更多...
vue2中用到了 vuex 实现一个 留言板效果

vue2中用到了 vuex 实现一个 留言板效果

一.效果图展示&#xff1a; 二.静态网页&#xff08;html&#xff09;代码 <template><div><h1>班级留言板</h1><ol><li v-for"(msg, index) in classmsgs" :key"index">{{ msg }} <a href"#" click.p…
阅读更多...
折叠屏、曲面屏始终都是少数派，凭啥挑战iPhone16？

折叠屏、曲面屏始终都是少数派，凭啥挑战iPhone16？

国内手机市场是一个很特别的市场&#xff0c;眼见着在处理器性能、拍照等方面都已无法再挑战苹果&#xff0c;国产手机这几年紧紧抓住折叠屏、曲面屏等差异化技术&#xff0c;试图与苹果掰手腕&#xff0c;然而从现实来看&#xff0c;这些技术其实都已失败了。 曲面屏基本可以说…
阅读更多...
直接计算法计算CRC-32/MPEG-2

直接计算法计算CRC-32/MPEG-2

代码&#xff1a; #include<stdio.h>#define BUFFER_SIZE 114typedef unsigned int uint32_t; typedef unsigned char uint8_t;uint8_t output[BUFFER_SIZE*4]; static const uint32_t aDataBuffer[BUFFER_SIZE] {0x00001021, 0x20423063, 0x408450a5, 0x60c670e7, …
阅读更多...
引领八亿人的“发现感”，深度旅游时代正式到来

引领八亿人的“发现感”，深度旅游时代正式到来

原文链接&#xff1a;深度旅游新纪元已降临&#xff0c;我们正带领八亿旅行者开启探索之旅&#xff0c;发现世界的无限精彩 一些人在旅行时渴望探索全新的城市&#xff0c;体验那里独特的风情&#xff1b;而另一些人则被“必住榜”上的苏州平江华府酒店吸引&#xff0c;想要亲…
阅读更多...
计算机毕业设计Spark+PyTorch股票推荐系统 股票预测系统 股票可视化 股票数据分析 量化交易系统 股票爬虫 股票K线图 大数据毕业设计 AI

计算机毕业设计Spark+PyTorch股票推荐系统 股票预测系统 股票可视化 股票数据分析 量化交易系统 股票爬虫 股票K线图 大数据毕业设计 AI

《SparkPyTorch股票推荐与预测系统》开题报告 一、研究背景与意义 随着信息技术的飞速发展和全球金融市场的日益繁荣&#xff0c;股票投资已成为广大投资者的重要选择之一。然而&#xff0c;股票市场的复杂性和不确定性使得投资者在做出投资决策时面临巨大的挑战。传统的股票…
阅读更多...
ceph中pg与pool关系

ceph中pg与pool关系

在Ceph中&#xff0c;PG&#xff08;Placement Group&#xff09;和Pool是非常重要的概念&#xff0c;它们在Ceph的存储架构中扮演着关键角色。理解这些概念有助于更好地管理和优化Ceph集群。下面详细介绍这两个概念及其相互关系。 Pool&#xff08;存储池&#xff09; 定义&am…
阅读更多...
牧野机床采集数据

牧野机床采集数据

牧野于1958年研发出日本第一数控铣床，并于1966年研发成功日本第一台加工中心。我在市面上常见的到的加工中心P5、P6系统，其余的就是EDM数控系统。他们两个用的不是同一种系统，采集方式也有区别，大家要注意。 牧野机床（中国）有限公司，于2002年7月23日在江苏昆山成立，是一…
阅读更多...
推荐文章
最新文章

Copyright @ 2022~2023