Public feed #9cNQbEMwHT

激光追踪云台

public profile only c v1 · immutable
Raw Edit
·published 2026-11-01 08:59 UTC
rendered paste body
#include "stm32f10x.h"#include "Delay.h"#include "LED.h"#include "Key.h"#include "OLED.h"#include "PWM.h"#include "Servo.h"#include <math.h>/*==================================================== * STM32F103C8T6 双 MG995 激光追踪云台主程序 * * 按键: *   PB1  -> Key_GetNum() 返回 1:设置圈数,1~5循环 *   PB11 -> Key_GetNum() 返回 2:启动轨迹 * * 舵机: *   Servo_SetAngle2() -> TIM2_CH2 -> PA1:水平舵机 *   Servo_SetAngle3() -> TIM2_CH3 -> PA2:竖直舵机 * * 注意:Servo_Init() 内部已调用 PWM_Init(),因此这里不重复初始化。 *====================================================*//* 屏幕与云台参数,单位:mm */#define SCREEN_DISTANCE_MM     1500.0f/* * 屏幕外沿 300 mm x 210 mm,胶带宽度约 18 mm。 * 以下按胶带中心线规划轨迹: * X 半宽 = (300 - 18) / 2 = 141 mm * Y 半高 = (210 - 18) / 2 = 96 mm * 如需按屏幕外沿运行,改为 150 mm 和 105 mm。 */#define HALF_WIDTH_MM          141.0f#define HALF_HEIGHT_MM          96.0f#define RAD_TO_DEG              57.2957795f/* 舵机角度校准:中心位置为 90 度 */#define SERVO_H_CENTER_DEG      90.0f#define SERVO_V_CENTER_DEG      101.8f/* * 方向修正:如果水平向右实际向左,将 H_DIR 改为 -1; * 如果屏幕向上实际向下,将 V_DIR 改为 -1。 */#define H_DIR                   1.0f#define V_DIR                   1.0f/* MG995 角度限幅,避免初次调试时冲击机械限位 */#define SERVO_MIN_DEG           45.0f#define SERVO_MAX_DEG           135.0f/* 轨迹插值参数 */#define MOVE_STEP_MM            30.0f#define MOVE_DELAY_MS           40#define CORNER_DELAY_MS         120/* ===== 经验校准参数:补偿舵机非线性与机械安装误差 ===== */#define H_GAIN          1.02f    /* 水平幅度增益:左/右不够宽时增大 */#define V_GAIN          1.07f    /* 竖直幅度增益:上/下不够高时增大 */#define H_OFFSET_DEG    0.0f    /* 水平整体偏移:整体偏右→负;偏左→正(H_DIR=1时) */#define V_OFFSET_DEG    0.0f    /* 竖直整体偏移:整体偏下→正;偏上→负(V_DIR=1时) *//* 轨迹整体水平偏移,补偿齿隙/光轴偏心;负值=左移,单位 mm */#define TRACK_X_SHIFT_MM    (+16.0f)#define TX(x)   ((x) + TRACK_X_SHIFT_MM)/* 当前光斑在屏幕坐标系中的位置,原点为屏幕中心 *//* 轨迹整体竖直偏移,补偿齿隙/光轴偏心;负值=下移,正值=上移,单位 mm */#define TRACK_Y_SHIFT_MM    (-5.0f)     /* 先按实测偏上量填,负号=下移 */#define TY(y)   ((y) + TRACK_Y_SHIFT_MM)static float CurrentX = 0.0f;static float CurrentY = 0.0f;/* 当前设置的圈数 */static uint8_t LoopCount = 1;/* 将舵机角度限制在安全范围内 */static float LimitServoAngle(float Angle){    if (Angle < SERVO_MIN_DEG)    {        Angle = SERVO_MIN_DEG;    }    else if (Angle > SERVO_MAX_DEG)    {        Angle = SERVO_MAX_DEG;    }    return Angle;}/* * 根据屏幕坐标 (x, y) 计算两个舵机角度。 * x 正方向:屏幕向右;y 正方向:屏幕向上。 */static void Gimbal_SetTarget(float x, float y){    float PanAngle;    float TiltAngle;    float HorizontalDistance;    float HorizontalServoAngle;    float VerticalServoAngle;    PanAngle = atan2f(x, SCREEN_DISTANCE_MM) * RAD_TO_DEG;    HorizontalDistance = sqrtf(SCREEN_DISTANCE_MM * SCREEN_DISTANCE_MM + x * x);    TiltAngle = atan2f(y, HorizontalDistance) * RAD_TO_DEG;	HorizontalServoAngle = SERVO_H_CENTER_DEG + H_OFFSET_DEG + H_DIR * H_GAIN * PanAngle;	VerticalServoAngle   = SERVO_V_CENTER_DEG + V_OFFSET_DEG + V_DIR * V_GAIN * TiltAngle;    HorizontalServoAngle = LimitServoAngle(HorizontalServoAngle);    VerticalServoAngle = LimitServoAngle(VerticalServoAngle);    Servo_SetAngle2(HorizontalServoAngle);    Servo_SetAngle3(VerticalServoAngle);}/* 从当前位置沿直线移动到目标坐标 */static void Gimbal_MoveTo(float TargetX, float TargetY){    float StartX;    float StartY;    float DeltaX;    float DeltaY;    float MaxDelta;    float t;    float x;    float y;    int Steps;    int i;    StartX = CurrentX;    StartY = CurrentY;    DeltaX = TargetX - StartX;    DeltaY = TargetY - StartY;    if (fabsf(DeltaX) > fabsf(DeltaY))    {        MaxDelta = fabsf(DeltaX);    }    else    {        MaxDelta = fabsf(DeltaY);    }    Steps = (int)(MaxDelta / MOVE_STEP_MM);    if ((float)Steps * MOVE_STEP_MM < MaxDelta)    {        Steps++;    }    if (Steps < 1)    {        Steps = 1;    }    for (i = 1; i <= Steps; i++)    {        t = (float)i / (float)Steps;        x = StartX + DeltaX * t;        y = StartY + DeltaY * t;        Gimbal_SetTarget(x, y);        Delay_ms(MOVE_DELAY_MS);    }    CurrentX = TargetX;    CurrentY = TargetY;}/* OLED 显示待机界面 */static void OLED_ShowReady(void){    OLED_Clear();    OLED_ShowString(1, 1, "Laser Gimbal");    OLED_ShowString(2, 1, "Loops: ");    OLED_ShowNum(2, 8, LoopCount, 1);    OLED_ShowString(3, 1, "K1: Set loops");    OLED_ShowString(4, 1, "K2: Start");}/* 执行 N 圈矩形轨迹 */static void Gimbal_RunTrajectory(uint8_t N){    uint8_t i;    if ((N < 1) || (N > 5))    {        return;    }    OLED_Clear();    OLED_ShowString(1, 1, "Trajectory Run");    OLED_ShowString(2, 1, "Total: ");    OLED_ShowNum(2, 8, N, 1);    LED1_ON();                 /* LED1 作为运行状态指示灯 */    /* 回到中心原点,再开始轨迹 */    CurrentX = 0.0f;    CurrentY = 0.0f;    Gimbal_SetTarget(0.0f, 0.0f);    Delay_ms(500);     /* 原点 -> 右侧边线中点 */    Gimbal_MoveTo(TX(HALF_WIDTH_MM), 0.0f);    /* 从右侧中点开始,依次沿上、左、下边线逆时针运行 */    for (i = 0; i < N; i++)    {        OLED_ShowString(3, 1, "Loop: ");        OLED_ShowNum(3, 7, (uint32_t)(i + 1), 1);        OLED_ShowString(3, 8, "/");        OLED_ShowNum(3, 9, N, 1);        /* 右侧中点 -> 右上角 */        Gimbal_MoveTo(TX( HALF_WIDTH_MM), TY( HALF_HEIGHT_MM));        Delay_ms(CORNER_DELAY_MS);        /* 右上角 -> 左上角 */		Gimbal_MoveTo(TX(-HALF_WIDTH_MM), TY( HALF_HEIGHT_MM));        Delay_ms(CORNER_DELAY_MS);        /* 左上角 -> 左下角 */        Gimbal_MoveTo(TX(-HALF_WIDTH_MM), TY(-HALF_HEIGHT_MM));        Delay_ms(CORNER_DELAY_MS);        /* 左下角 -> 右下角 */        Gimbal_MoveTo(TX( HALF_WIDTH_MM), TY(-HALF_HEIGHT_MM));        Delay_ms(CORNER_DELAY_MS);        /* 右下角 -> 右侧边线中点,完成一圈 */        Gimbal_MoveTo(TX( HALF_WIDTH_MM),  0.0f);        Delay_ms(CORNER_DELAY_MS);	}    /* 完成 N 圈后,右侧中点 -> 原点 */    Gimbal_MoveTo(0.0f, 0.0f);    Delay_ms(300);    LED1_OFF();    OLED_Clear();    OLED_ShowString(1, 1, "Trajectory Done");    OLED_ShowString(2, 1, "Returned Origin");    OLED_ShowString(4, 1, "K1:Set K2:Start");}int main(void){    uint8_t KeyNum;//	int i;    /* 初始化各模块 */    LED_Init();    Key_Init();    OLED_Init();    Servo_Init();            /* Servo_Init 内部调用 PWM_Init */    /* 两个舵机回到中心位置 */    Servo_SetAngle2(SERVO_H_CENTER_DEG);    Servo_SetAngle3(SERVO_V_CENTER_DEG);    Delay_ms(500);    LED1_OFF();    LED2_OFF();    OLED_ShowReady();///* ===== 临时校准:扫描垂直舵机,找打在屏幕中心的角度 ===== *///	//	OLED_Clear();//	OLED_ShowString(1, 1, "V Calibrate");//	for (i = 80; i <= 120; i += 5)//	{//    Servo_SetAngle3((float)i);//    OLED_ShowString(3, 1, "Angle: ");//    OLED_ShowNum(3, 8, (uint32_t)i, 3);//    Delay_ms(2000);     /* 每个角度停 2 秒,用眼睛看光斑位置 *///	}///* 记下光斑落在屏幕中心时的角度,写回 SERVO_V_CENTER_DEG */    while (1)    {        KeyNum = Key_GetNum();        if (KeyNum == 1)        {            /* PB1:圈数 1 -> 2 -> 3 -> 4 -> 5 -> 1 */            LoopCount++;            if (LoopCount > 5)            {                LoopCount = 1;            }            OLED_ShowReady();        }        else if (KeyNum == 2)        {            /* PB11:启动当前设置圈数的轨迹 */            Gimbal_RunTrajectory(LoopCount);        }        Delay_ms(10);    }}#include "stm32f10x.h"#include "Delay.h"void Key_Init(void){	RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);		GPIO_InitTypeDef GPIO_InitStructure;	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;  // 上拉输入	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1 | GPIO_Pin_11;	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;	GPIO_Init(GPIOB, &GPIO_InitStructure);}uint8_t Key_GetNum(void){	uint8_t KeyNum = 0;	// 静态变量,只初始化一次,保持记忆	static uint8_t key1_lock = 0; 	static uint8_t key2_lock = 0; 		// ---------------- 检测按键1 (PB1) ----------------	if (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_1) == 0 && key1_lock == 0)	{		Delay_ms(20); // 消抖		if (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_1) == 0) // 再次确认		{			KeyNum = 1;			key1_lock = 1; // 锁定,直到松手		}	}	else if (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_1) == 1) // 松手检测	{		key1_lock = 0; // 松手解锁	}		// ---------------- 检测按键2 (PB11) ----------------	if (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_11) == 0 && key2_lock == 0)	{		Delay_ms(20); // 消抖		if (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_11) == 0)		{			KeyNum = 2;			key2_lock = 1; // 锁定		}	}	else if (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_11) == 1)	{		key2_lock = 0; // 松手解锁	}		return KeyNum;}#include "stm32f10x.h"void PWM_Init(void){	RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);	RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);		GPIO_InitTypeDef GPIO_InitStructure;	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1 | GPIO_Pin_2;  // PA1, PA2	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;	GPIO_Init(GPIOA, &GPIO_InitStructure);		TIM_InternalClockConfig(TIM2);		TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure;	TIM_TimeBaseInitStructure.TIM_ClockDivision = TIM_CKD_DIV1;	TIM_TimeBaseInitStructure.TIM_CounterMode = TIM_CounterMode_Up;	TIM_TimeBaseInitStructure.TIM_Period = 20000 - 1;		// 50Hz	TIM_TimeBaseInitStructure.TIM_Prescaler = 72 - 1;		// 1MHz 计数	TIM_TimeBaseInitStructure.TIM_RepetitionCounter = 0;	TIM_TimeBaseInit(TIM2, &TIM_TimeBaseInitStructure);		TIM_OCInitTypeDef TIM_OCInitStructure;		// 配置通道2 (PA1)	TIM_OCStructInit(&TIM_OCInitStructure);	TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;	TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;	TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;	TIM_OCInitStructure.TIM_Pulse = 1500; // 默认给 1.5ms (中位)	TIM_OC2Init(TIM2, &TIM_OCInitStructure);    TIM_OC2PreloadConfig(TIM2, TIM_OCPreload_Enable); // 新增:开启预装载		// 配置通道3 (PA2)	TIM_OCStructInit(&TIM_OCInitStructure);	TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;	TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;	TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;	TIM_OCInitStructure.TIM_Pulse = 1500; // 默认给 1.5ms (中位)	TIM_OC3Init(TIM2, &TIM_OCInitStructure);    TIM_OC3PreloadConfig(TIM2, TIM_OCPreload_Enable); // 新增:开启预装载		TIM_Cmd(TIM2, ENABLE);}void PWM_SetCompare2(uint16_t Compare){	TIM_SetCompare2(TIM2, Compare);}void PWM_SetCompare3(uint16_t Compare){	TIM_SetCompare3(TIM2, Compare);} #include "stm32f10x.h"                  // Device header#include "PWM.h"void Servo_Init(void){	PWM_Init();}void Servo_SetAngle2(float Angle){	PWM_SetCompare2((uint16_t)(Angle / 180.0f * 2000.0f + 500.0f));}void Servo_SetAngle3(float Angle){	PWM_SetCompare3((uint16_t)(Angle / 180.0f * 2000.0f + 500.0f));}#include "stm32f10x.h"                  // Device headervoid LED_Init(void){	RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA,ENABLE);		GPIO_InitTypeDef GPIO_InitStructure;	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1 | GPIO_Pin_2;	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;	GPIO_Init(GPIOA, &GPIO_InitStructure);		GPIO_SetBits(GPIOA, GPIO_Pin_1 | GPIO_Pin_2);}void LED1_ON(void){	GPIO_ResetBits(GPIOA, GPIO_Pin_1);}void LED1_OFF(void){	GPIO_SetBits(GPIOA, GPIO_Pin_1);}void LED1_Turn(void){	if (GPIO_ReadOutputDataBit(GPIOA, GPIO_Pin_1) == 0)	{		GPIO_SetBits(GPIOA, GPIO_Pin_1);	}	else	{		GPIO_ResetBits(GPIOA, GPIO_Pin_1);	}}void LED2_ON(void){	GPIO_ResetBits(GPIOA, GPIO_Pin_2);}void LED2_OFF(void){	GPIO_SetBits(GPIOA, GPIO_Pin_2);}void LED2_Turn(void){	if (GPIO_ReadOutputDataBit(GPIOA, GPIO_Pin_2) == 0)	{		GPIO_SetBits(GPIOA, GPIO_Pin_2);	}	else	{		GPIO_ResetBits(GPIOA, GPIO_Pin_2);	}}#include "stm32f10x.h"#include "OLED_Font.h"/*引脚配置*/#define OLED_W_SCL(x)		GPIO_WriteBit(GPIOB, GPIO_Pin_8, (BitAction)(x))#define OLED_W_SDA(x)		GPIO_WriteBit(GPIOB, GPIO_Pin_9, (BitAction)(x))/*引脚初始化*/void OLED_I2C_Init(void){    RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);		GPIO_InitTypeDef GPIO_InitStructure; 	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_OD;	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_8; 	GPIO_Init(GPIOB, &GPIO_InitStructure);	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9; 	GPIO_Init(GPIOB, &GPIO_InitStructure);		OLED_W_SCL(1);	OLED_W_SDA(1);}/**  * @brief  I2C开始  * @param  无  * @retval 无  */void OLED_I2C_Start(void){	OLED_W_SDA(1);	OLED_W_SCL(1);	OLED_W_SDA(0);	OLED_W_SCL(0);}/**  * @brief  I2C停止  * @param  无  * @retval 无  */void OLED_I2C_Stop(void){	OLED_W_SDA(0);	OLED_W_SCL(1);	OLED_W_SDA(1);}/**  * @brief  I2C发送一个字节  * @param  Byte 要发送的一个字节  * @retval 无  */void OLED_I2C_SendByte(uint8_t Byte){	uint8_t i;	for (i = 0; i < 8; i++)	{		OLED_W_SDA(Byte & (0x80 >> i));		OLED_W_SCL(1);		OLED_W_SCL(0);	}	OLED_W_SCL(1);	//额外的一个时钟,不处理应答信号	OLED_W_SCL(0);}/**  * @brief  OLED写命令  * @param  Command 要写入的命令  * @retval 无  */void OLED_WriteCommand(uint8_t Command){	OLED_I2C_Start();	OLED_I2C_SendByte(0x78);		//从机地址	OLED_I2C_SendByte(0x00);		//写命令	OLED_I2C_SendByte(Command); 	OLED_I2C_Stop();}/**  * @brief  OLED写数据  * @param  Data 要写入的数据  * @retval 无  */void OLED_WriteData(uint8_t Data){	OLED_I2C_Start();	OLED_I2C_SendByte(0x78);		//从机地址	OLED_I2C_SendByte(0x40);		//写数据	OLED_I2C_SendByte(Data);	OLED_I2C_Stop();}/**  * @brief  OLED设置光标位置  * @param  Y 以左上角为原点,向下方向的坐标,范围:0~7  * @param  X 以左上角为原点,向右方向的坐标,范围:0~127  * @retval 无  */void OLED_SetCursor(uint8_t Y, uint8_t X){	OLED_WriteCommand(0xB0 | Y);					//设置Y位置	OLED_WriteCommand(0x10 | ((X & 0xF0) >> 4));	//设置X位置高4位	OLED_WriteCommand(0x00 | (X & 0x0F));			//设置X位置低4位}/**  * @brief  OLED清屏  * @param  无  * @retval 无  */void OLED_Clear(void){  	uint8_t i, j;	for (j = 0; j < 8; j++)	{		OLED_SetCursor(j, 0);		for(i = 0; i < 128; i++)		{			OLED_WriteData(0x00);		}	}}/**  * @brief  OLED显示一个字符  * @param  Line 行位置,范围:1~4  * @param  Column 列位置,范围:1~16  * @param  Char 要显示的一个字符,范围:ASCII可见字符  * @retval 无  */void OLED_ShowChar(uint8_t Line, uint8_t Column, char Char){      		uint8_t i;	OLED_SetCursor((Line - 1) * 2, (Column - 1) * 8);		//设置光标位置在上半部分	for (i = 0; i < 8; i++)	{		OLED_WriteData(OLED_F8x16[Char - ' '][i]);			//显示上半部分内容	}	OLED_SetCursor((Line - 1) * 2 + 1, (Column - 1) * 8);	//设置光标位置在下半部分	for (i = 0; i < 8; i++)	{		OLED_WriteData(OLED_F8x16[Char - ' '][i + 8]);		//显示下半部分内容	}}/**  * @brief  OLED显示字符串  * @param  Line 起始行位置,范围:1~4  * @param  Column 起始列位置,范围:1~16  * @param  String 要显示的字符串,范围:ASCII可见字符  * @retval 无  */void OLED_ShowString(uint8_t Line, uint8_t Column, char *String){	uint8_t i;	for (i = 0; String[i] != '\0'; i++)	{		OLED_ShowChar(Line, Column + i, String[i]);	}}/**  * @brief  OLED次方函数  * @retval 返回值等于X的Y次方  */uint32_t OLED_Pow(uint32_t X, uint32_t Y){	uint32_t Result = 1;	while (Y--)	{		Result *= X;	}	return Result;}/**  * @brief  OLED显示数字(十进制,正数)  * @param  Line 起始行位置,范围:1~4  * @param  Column 起始列位置,范围:1~16  * @param  Number 要显示的数字,范围:0~4294967295  * @param  Length 要显示数字的长度,范围:1~10  * @retval 无  */void OLED_ShowNum(uint8_t Line, uint8_t Column, uint32_t Number, uint8_t Length){	uint8_t i;	for (i = 0; i < Length; i++)								{		OLED_ShowChar(Line, Column + i, Number / OLED_Pow(10, Length - i - 1) % 10 + '0');	}}/**  * @brief  OLED显示数字(十进制,带符号数)  * @param  Line 起始行位置,范围:1~4  * @param  Column 起始列位置,范围:1~16  * @param  Number 要显示的数字,范围:-2147483648~2147483647  * @param  Length 要显示数字的长度,范围:1~10  * @retval 无  */void OLED_ShowSignedNum(uint8_t Line, uint8_t Column, int32_t Number, uint8_t Length){	uint8_t i;	uint32_t Number1;	if (Number >= 0)	{		OLED_ShowChar(Line, Column, '+');		Number1 = Number;	}	else	{		OLED_ShowChar(Line, Column, '-');		Number1 = -Number;	}	for (i = 0; i < Length; i++)								{		OLED_ShowChar(Line, Column + i + 1, Number1 / OLED_Pow(10, Length - i - 1) % 10 + '0');	}}/**  * @brief  OLED显示数字(十六进制,正数)  * @param  Line 起始行位置,范围:1~4  * @param  Column 起始列位置,范围:1~16  * @param  Number 要显示的数字,范围:0~0xFFFFFFFF  * @param  Length 要显示数字的长度,范围:1~8  * @retval 无  */void OLED_ShowHexNum(uint8_t Line, uint8_t Column, uint32_t Number, uint8_t Length){	uint8_t i, SingleNumber;	for (i = 0; i < Length; i++)								{		SingleNumber = Number / OLED_Pow(16, Length - i - 1) % 16;		if (SingleNumber < 10)		{			OLED_ShowChar(Line, Column + i, SingleNumber + '0');		}		else		{			OLED_ShowChar(Line, Column + i, SingleNumber - 10 + 'A');		}	}}/**  * @brief  OLED显示数字(二进制,正数)  * @param  Line 起始行位置,范围:1~4  * @param  Column 起始列位置,范围:1~16  * @param  Number 要显示的数字,范围:0~1111 1111 1111 1111  * @param  Length 要显示数字的长度,范围:1~16  * @retval 无  */void OLED_ShowBinNum(uint8_t Line, uint8_t Column, uint32_t Number, uint8_t Length){	uint8_t i;	for (i = 0; i < Length; i++)								{		OLED_ShowChar(Line, Column + i, Number / OLED_Pow(2, Length - i - 1) % 2 + '0');	}}/**  * @brief  OLED初始化  * @param  无  * @retval 无  */void OLED_Init(void){	uint32_t i, j;		for (i = 0; i < 1000; i++)			//上电延时	{		for (j = 0; j < 1000; j++);	}		OLED_I2C_Init();			//端口初始化		OLED_WriteCommand(0xAE);	//关闭显示		OLED_WriteCommand(0xD5);	//设置显示时钟分频比/振荡器频率	OLED_WriteCommand(0x80);		OLED_WriteCommand(0xA8);	//设置多路复用率	OLED_WriteCommand(0x3F);		OLED_WriteCommand(0xD3);	//设置显示偏移	OLED_WriteCommand(0x00);		OLED_WriteCommand(0x40);	//设置显示开始行		OLED_WriteCommand(0xA1);	//设置左右方向,0xA1正常 0xA0左右反置		OLED_WriteCommand(0xC8);	//设置上下方向,0xC8正常 0xC0上下反置	OLED_WriteCommand(0xDA);	//设置COM引脚硬件配置	OLED_WriteCommand(0x12);		OLED_WriteCommand(0x81);	//设置对比度控制	OLED_WriteCommand(0xCF);	OLED_WriteCommand(0xD9);	//设置预充电周期	OLED_WriteCommand(0xF1);	OLED_WriteCommand(0xDB);	//设置VCOMH取消选择级别	OLED_WriteCommand(0x30);	OLED_WriteCommand(0xA4);	//设置整个显示打开/关闭	OLED_WriteCommand(0xA6);	//设置正常/倒转显示	OLED_WriteCommand(0x8D);	//设置充电泵	OLED_WriteCommand(0x14);	OLED_WriteCommand(0xAF);	//开启显示			OLED_Clear();				//OLED清屏}