SimpleBGC32-开源三轴无刷云台算法完全解说

共211个文件

h：95个

c：89个

s：8个

5星 · 超过95%的资源需积分: 47 132 浏览量 2016-09-19 23:54:18 上传评论 56 收藏 686KB ZIP 举报

SimpleBGC32是一款专为三轴无刷云台设计的开源控制器，它基于高性能的32位微控制器，能够实现精确、快速的电机控制，适用于各种无人机、相机稳定器等应用。本教程将深入解析SimpleBGC32的算法核心，帮助读者理解其工作原理并掌握实际操作技巧。一、SimpleBGC32硬件特性 SimpleBGC32控制器具有以下关键硬件特性： 1. 高性能32位微控制器：提供强大的计算能力，确保实时处理复杂的控制算法。 2. 多个电机驱动接口：支持三轴电机连接，可实现精准的三维姿态控制。 3. 各种传感器接口：如陀螺仪、加速度计、磁力计等，用于获取实时姿态数据。 4. 用户自定义接口：允许用户扩展额外功能，如无线模块、LED灯控等。二、无刷电机控制基础无刷电机的工作原理基于电机内部的永磁体和外部电磁场相互作用。SimpleBGC32通过改变电机线圈的电流方向来控制电机转速和方向，实现云台的精确转动。三、PID控制算法 SimpleBGC32的核心控制算法是PID（比例-积分-微分）控制器。PID算法通过结合当前误差（P）、历史误差积分（I）和误差变化率（D）来调整电机输出，实现对云台角度的稳定控制。 1. 比例项（P）：根据当前误差立即调整电机输出，快速响应。 2. 积分项（I）：考虑过去误差积累，消除系统偏移，提高稳定性。 3. 微分项（D）：预测未来误差趋势，减少超调，提高响应速度。四、传感器融合与卡尔曼滤波为了得到更准确的姿态信息，SimpleBGC32采用传感器融合技术，通常结合陀螺仪、加速度计和磁力计的数据。卡尔曼滤波是一种有效的数据融合方法，它可以结合不同传感器的测量结果，减少噪声并提高姿态估计的精度。五、实时通信协议 SimpleBGC32支持多种通信协议，如UART、I2C、SPI等，方便与上位机或遥控器进行数据交换。通过这些协议，用户可以设置参数、读取状态或实现云台的远程控制。六、固件升级与编程 SimpleBGC32的开源特性允许用户自行编写或修改固件，以适应特定的应用需求。常用的开发工具包括Arduino IDE和专用的SimpleBGC软件，它们提供了友好的图形界面和API函数库，使得编程变得更加简单。七、云台稳定算法云台稳定算法主要目标是保持相机的水平或设定角度。SimpleBGC32通过实时计算目标角度与实际角度的差值，并通过PID控制器调整电机，使云台在风阻、动态运动等复杂环境下保持稳定。总结： SimpleBGC32三轴无刷云台控制器以其强大的硬件性能和灵活的软件控制，为无人机和摄影设备的稳定拍摄提供了可靠的解决方案。通过深入理解其工作原理，特别是PID控制、传感器融合和卡尔曼滤波，用户不仅可以优化云台性能，还可以根据实际需求进行定制化开发。

资源推荐

资源详情

资源评论

收起资源包目录

SimpleBGC32- 开源三轴无刷云台算法完全解说（211个子文件）

STM32-DEMO.uvgui.Administrator 70KB

STM32-DEMO.uvgui_Administrator.bak 70KB

STM32-DEMO.uvgui_flyleaf.bak 66KB

STM32-DEMO_uvproj.bak 16KB

STM32-DEMO_uvopt.bak 11KB

stm32f10x_tim.c 107KB

stm32f10x_tim.c 104KB

stm32f10x_flash.c 61KB

stm32f10x_flash.c 59KB

stm32f10x_rcc.c 50KB

stm32f10x_rcc.c 49KB

stm32f10x_adc.c 46KB

stm32f10x_adc.c 45KB

stm32f10x_i2c.c 45KB

stm32f10x_can.c 44KB

stm32f10x_i2c.c 44KB

stm32f10x_can.c 43KB

stm32f10x_usart.c 37KB

system_stm32f10x.c 36KB

stm32f10x_fsmc.c 35KB

stm32f10x_fsmc.c 34KB

cli.c 31KB

usb_core.c 30KB

stm32f10x_spi.c 30KB

stm32f10x_dma.c 29KB

stm32f10x_spi.c 29KB

stm32f10x_dma.c 28KB

stm32f10x_sdio.c 28KB

usb_regs.c 28KB

stm32f10x_sdio.c 28KB

stm32f10x_gpio.c 23KB

drv_pwmMotors.c 20KB

stm32f10x_dac.c 19KB

stm32f10x_dac.c 18KB

drv_i2c.c 18KB

core_cm3.c 17KB

usb_prop.c 15KB

hw_config.c 14KB

mpu6050.c 14KB

drv_system.c 12KB

MargAHRS.c 11KB

stm32f10x_cec.c 11KB

utilities.c 11KB

stm32f10x_cec.c 11KB

usb_pwr.c 10KB

config.c 9KB

main.c 9KB

stm32f10x_rtc.c 9KB

stm32f10x_pwr.c 9KB

stm32f10x_rtc.c 8KB

stm32f10x_pwr.c 8KB

stm32f10x_bkp.c 8KB

cliSensor.c 8KB

stm32_it.c 8KB

pointingCommands.c 7KB

usb_desc.c 7KB

misc.c 7KB

stm32f10x_exti.c 7KB

misc.c 7KB

usb_istr.c 7KB

stm32f10x_exti.c 7KB

computeMotorCommands.c 7KB

firstOrderFilter.c 6KB

mpu6050Calibration.c 6KB

usb_int.c 6KB

stm32f10x_wwdg.c 6KB

drv_usart.c 6KB

pid.c 6KB

stm32f10x_wwdg.c 6KB

drv_cli.c 5KB

hmc5883.c 5KB

evvgcCF.c 5KB

stm32f10x_dbgmcu.c 5KB

stm32f10x_iwdg.c 5KB

stm32f10x_it.c 5KB

drv_rc.c 4KB

usb_sil.c 4KB

usb_mem.c 4KB

stm32f10x_crc.c 3KB

ringbuffer.c 3KB

stm32f10x_crc.c 3KB

usart1.c 3KB

usb_init.c 3KB

usb_endp.c 3KB

magCalibration.c 3KB

drv_timingFunctions.c 2KB

drv_gpio.c 2KB

fastTrig.c 2KB

drv_irq.c 199B

STM32-DEMO_USART1-DEMO.dep 35KB

STM32-DEMO_LED-DEMO.dep 6KB

STM32-DEMO_Target 1.dep 2KB

STM32-DEMO.uvgui.flyleaf 66KB

stm32f10x.h 619KB

core_cm3.h 84KB

共 211 条

T0448 000:074 SEGGER J-Link V4.68a Log File (0001ms, 0072ms total) T0448 000:074 DLL Compiled: Apr 12 2013 13:26:50 (0001ms, 0072ms total) T0448 000:074 Logging started @ 2016-08-26 01:02 (0001ms, 0072ms total) T0448 000:075 JLINK_SetWarnOutHandler(...) (0000ms, 0072ms total) T0448 000:075 JLINK_OpenEx(...) Firmware: J-Link ARM V8 compiled Nov 25 2013 19:20:08 Hardware: V8.00 S/N: 66445566 Feature(s): RDI,FlashDL,FlashBP,JFlash,GDBFULL returns O.K. (0017ms, 0089ms total) T0448 000:092 JLINK_SetErrorOutHandler(...) (0000ms, 0089ms total) T0448 000:092 JLINK_ExecCommand("ProjectFile = "C:\Users\Administrator\Desktop\mySelf Printf\source\USER\JLinkSettings.ini"", ...) returns 0x00 (0001ms, 0090ms total) T0448 000:097 JLINK_ExecCommand("Device = STM32F103VE", ...) JLINK_AddMirrorAreaEx(Addr = 0x00000000, Size = 0x00000000) (0000ms, 0000ms total) Device "STM32F103VE" selected (512 KB flash, 64 KB RAM). returns 0x00 (0006ms, 0096ms total) T0448 000:103 JLINK_ExecCommand("DisableConnectionTimeout", ...) returns 0x00 (0000ms, 0096ms total) T0448 000:103 JLINK_GetHardwareVersion() returns 0x13880 (0000ms, 0096ms total) T0448 000:103 JLINK_GetDLLVersion() returns 46801 (0000ms, 0096ms total) T0448 000:103 JLINK_GetFirmwareString(...) (0000ms, 0096ms total) T0448 000:109 JLINK_GetDLLVersion() returns 46801 (0000ms, 0096ms total) T0448 000:109 JLINK_GetCompileDateTime() (0000ms, 0096ms total) T0448 000:111 JLINK_GetFirmwareString(...) (0000ms, 0096ms total) T0448 000:113 JLINK_GetHardwareVersion() returns 0x13880 (0000ms, 0096ms total) T0448 000:129 JLINK_TIF_Select(JLINKARM_TIF_JTAG) returns 0x00 (0000ms, 0097ms total) T0448 000:129 JLINK_SetSpeed(2000) (0001ms, 0098ms total) T0448 000:130 JLINK_GetIdData(...) >0x2F8 JTAG>TotalIRLen = 9, IRPrint = 0x0011 >0x30 JTAG> >0x210 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x2F8 JTAG>TotalIRLen = 9, IRPrint = 0x0011 >0x30 JTAG> >0x210 JTAG> >0x80 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x38 JTAG> >0x80 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x80 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x80 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> Found Cortex-M3 r1p1, Little endian. >0x50 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x30 JTAG> >0x50 JTAG> >0x40 JTAG> >0x80 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG>TPIU fitted. >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG>ETM fitted. >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG>FPUnit: 6 code (BP) slots and 2 literal slots >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x30 JTAG> >0x50 JTAG> >0x40 JTAG> ScanLen=9 NumDevices=2 aId[0]=0x3BA00477 aIrRead[0]=0 aScanLen[0]=0 aScanRead[0]=0 (0095ms, 0193ms total) T0448 000:225 JLINK_JTAG_GetDeviceID(DeviceIndex = 0) returns 0x3BA00477 (0000ms, 0193ms total) T0448 000:225 JLINK_JTAG_GetDeviceInfo(DeviceIndex = 0) returns 0x00 (0000ms, 0193ms total) T0448 000:225 JLINK_JTAG_GetDeviceID(DeviceIndex = 1) returns 0x6414041 (0000ms, 0193ms total) T0448 000:225 JLINK_JTAG_GetDeviceInfo(DeviceIndex = 1) returns 0x00 (0000ms, 0193ms total) T0448 000:225 JLINK_GetDeviceFamily() returns 3 (0000ms, 0193ms total) T0448 000:228 JLINK_ReadMem (0xE00FFFF0, 0x0010 Bytes, ...) -- CPU is running -- CPU_ReadMem(16 bytes @ 0xE00FFFF0) -- Data: 0D 00 00 00 10 00 00 00 05 00 00 00 B1 00 00 00 returns 0x00 (0005ms, 0198ms total) T0448 000:233 JLINK_ReadMem (0xE00FFFD0, 0x0020 Bytes, ...) -- CPU is running -- CPU_ReadMem(32 bytes @ 0xE00FFFD0) -- Data: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 ... returns 0x00 (0002ms, 0200ms total) T0448 000:235 JLINK_ReadMem (0xE00FF000, 0x0018 Bytes, ...) -- CPU is running -- CPU_ReadMem(24 bytes @ 0xE00FF000) -- Data: 03 F0 F0 FF 03 20 F0 FF 03 30 F0 FF 03 10 F0 FF ... returns 0x00 (0001ms, 0201ms total) T0448 000:236 JLINK_ReadMemU32(0xE000ED00, 0x0001 Items, ...) -- CPU is running -- CPU_ReadMem(4 bytes @ 0xE000ED00) -- Data: 31 C2 1F 41 returns 0x01 (0001ms, 0202ms total) T0448 000:237 JLINK_SetResetType(JLINKARM_RESET_TYPE_NORMAL) returns JLINKARM_RESET_TYPE_NORMAL (0000ms, 0202ms total) T0448 000:237 JLINK_Reset() >0x88 JTAG> >0x80 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x80 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x80 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG>Found Cortex-M3 r1p1, Little endian. >0x50 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x30 JTAG> >0x50 JTAG> >0x40 JTAG> >0x80 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG>TPIU fitted. >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG>ETM fitted. >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG>FPUnit: 6 code (BP) slots and 2 literal slots >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> >0x40 JTAG> >0x40 JTAG> >0x30 JTAG> >0x30 JTAG> >0x50 JTAG> >0x40 JTAG> -- CPU is running -- CPU_WriteMem(4 bytes @ 0xE000EDF0) -- CPU is running -- CPU_WriteMem(4 bytes @ 0xE000EDFC) -- CPU is running -- CPU_WriteMem(4 bytes @ 0xE000ED0C) -- CPU is running -- CPU_ReadMem(4 bytes @ 0xE000EDF0) -- CPU is running -- CPU_ReadMem(4 bytes @ 0xE000EDF0) -- CPU is running -- CPU_WriteMem(4 bytes @ 0xE000EDF0) -- CPU is running -- CPU_WriteMem(4 bytes @ 0xE000EDFC) -- CPU is running -- CPU_ReadMem(4 bytes @ 0xE000EDF0) >0xD0 JTAG> >0x40 JTAG> >0x30 JTAG> >0x40 JTAG> >0x50 JTAG> >0x40 JTAG> -- CPU_WriteMem(4 bytes @ 0xE000EDFC) -- CPU_WriteMem(4 bytes @ 0xE0001028) -- CPU_WriteMem(4 bytes @ 0xE0001038) -- CPU_WriteMem(4 bytes @ 0xE0001048) -- CPU_WriteMem(4 bytes @ 0xE0001058) -- CPU_WriteMem(4 bytes @ 0xE0002000) (0111ms, 0313ms total) T0448 000:348 JLINK_Halt() returns 0x00 (0000ms, 0313ms total) T0448 000:348 JLINK_IsHalted() returns TRUE (0000ms, 0313ms total) T0448 000:348 JLINK_ReadMemU32(0xE000EDF0, 0x0001 Items, ...) -- CPU_ReadMem(4 bytes @ 0xE000EDF0) -- Data: 03 00 03 00 returns 0x01 (0001ms, 0314ms total) T0448 000:349 JLINK_WriteU32(0xE000EDF0, 0xA05F0003) -- CPU_WriteMem(4 bytes @ 0xE000EDF0) returns 0x00 (0001ms, 0315ms total) T0448 000:350 JLINK_WriteU32(0xE000EDFC, 0x01000000) -- CPU_WriteMem(4 bytes @ 0xE000EDFC) returns 0x00 (0000ms, 0315ms total) T0448 000:362 JLINK_GetHWStatus(...) returns 0x00 (0000ms, 0316ms total) T0448 000:369 JLINK_GetNumBPUnits(Type = 0xFFFFFF00) returns 0x06 (0000ms, 0316ms total) T0448 000:369 JLINK_GetNumBPUnits(Type = 0xF0) returns 0x2000 (0000ms, 0316ms total) T0448 000:369 JLINK_GetNumWPUnits() returns 0x04 (0000ms, 0316ms total) T0448 000:377 JLI

评论收藏

内容反馈