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