skip to main content
paste
bin
.ca
type · paste · share
⌘
K
Sign in
?
Account
More
▾
Docs
Family
The bin family
pastebin.ca
hub
Share text and code with expiry and privacy controls.
imagebin.ca
Upload and share images with direct links.
filebin.ca
Drop a file and get a shareable link.
notebin.ca
Write Markdown notes with durable links.
turl.ca
Short, reputation-checked links.
attn.ca
Notifications and alerts for your services.
voicebin.ca
Record and share short voice clips.
dnsbin.ca
Inspect DNS and debug records.
← back to paste
›
Edit / fork
激光追踪云台
#9cNQbEMwHT
profile / public
new version
anonymous
created 21 days ago
Expires in 2 months
20.1 KB
syntax:
c
Your changes create a new paste linked to this one — the original is untouched.
new version
Your changes create a new paste linked to this one — the original is untouched.
Title (optional)
Filename
Syntax
c
text
bash
c
cpp
css
diff
dockerfile
go
html
ini
java
javascript
json
kotlin
lua
makefile
markdown
nginx
php
python
ruby
rust
shellscript
sql
swift
toml
typescript
xml
yaml
Visibility
Show on user feed
Access
public
Expires
90 days
10 min
1 hour
1 day
7 days
30 days
90 days
custom…
Custom expiry
Change note
(optional)
Create new version
Cancel
Paste or type…
#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 header void 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清屏 }