STM32 旋转倒立摆程序

13年国赛控制题，旋转倒立摆。使用STM32作为主控CPU，采用了摆杆的角度环以及电机的角位移环进行控制，效果挺好的

/**************************************************************************//**
 * @file     core_cm3.c
 * @brief    CMSIS Cortex-M3 Core Peripheral Access layer Source File
 * @version  V1.30
 * @date     30. October 2009
 *
 * @note
 * Copyright （C） 2009 ARM Limited. All rights reserved.
 *
 * @par
 * ARM Limited （ARM） is supplying this software for use with Cortex-M 
 * processor based microcontrollers.  This file can be freely distributed 
 * within development tools that are supporting such ARM based processors. 
 *
 * @par
 * THIS SOFTWARE IS PROVIDED “AS IS“.  NO WARRANTIES WHETHER EXPRESS IMPLIED
 * OR STATUTORY INCLUDING BUT NOT LIMITED TO IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE APPLY TO THIS SOFTWARE.
 * ARM SHALL NOT IN ANY CIRCUMSTANCES BE LIABLE FOR SPECIAL INCIDENTAL OR
 * CONSEQUENTIAL DAMAGES FOR ANY REASON WHATSOEVER.
 *
 ******************************************************************************/

#include 

/* define compiler specific symbols */
#if defined （ __CC_ARM   ）
  #define __ASM            __asm                                      /*!< asm keyword for ARM Compiler          */
  #define __INLINE         __inline                                   /*!< inline keyword for ARM Compiler       */

#elif defined （ __ICCARM__ ）
  #define __ASM           __asm                                       /*!< asm keyword for IAR Compiler          */
  #define __INLINE        inline                                      /*!< inline keyword for IAR Compiler. Only avaiable in High optimization mode! */

#elif defined   （  __GNUC__  ）
  #define __ASM            __asm                                      /*!< asm keyword for GNU Compiler          */
  #define __INLINE         inline                                     /*!< inline keyword for GNU Compiler       */

#elif defined   （  __TASKING__  ）
  #define __ASM            __asm                                      /*!< asm keyword for TASKING Compiler      */
  #define __INLINE         inline                                     /*!< inline keyword for TASKING Compiler   */

#endif


/* ###################  Compiler specific Intrinsics  ########################### */

#if defined （ __CC_ARM   ） /*------------------RealView Compiler -----------------*/
/* ARM armcc specific functions */

/**
 * @brief  Return the Process Stack Pointer
 *
 * @return ProcessStackPointer
 *
 * Return the actual process stack pointer
 */
__ASM uint32_t __get_PSP（void）
{
  mrs r0 psp
  bx lr
}

/**
 * @brief  Set the Process Stack Pointer
 *
 * @param  topOfProcStack  Process Stack Pointer
 *
 * Assign the value ProcessStackPointer to the MSP 
 * （process stack pointer） Cortex processor register
 */
__ASM void __set_PSP（uint32_t topOfProcStack）
{
  msr psp r0
  bx lr
}

/**
 * @brief  Return the Main Stack Pointer
 *
 * @return Main Stack Pointer
 *
 * Return the curren

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件        140  2014-07-25 10:04  倒立摆 PID双环\config.dat

     文件     141946  2014-08-01 19:44  倒立摆 PID双环\旋转倒立摆\JlinkLog.txt

     文件        578  2014-06-12 15:10  倒立摆 PID双环\旋转倒立摆\JlinkSettings.ini

     文件      17273  2010-06-07 10:25  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\CoreSupport\core_cm3.c

     文件      85714  2011-02-09 14:59  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\CoreSupport\core_cm3.h

     文件      26297  2011-03-14 12:31  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\Release_Notes.html

     文件      15766  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\arm\startup_stm32f10x_cl.s

     文件      15503  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\arm\startup_stm32f10x_hd.s

     文件      15692  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\arm\startup_stm32f10x_hd_vl.s

     文件      12376  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\arm\startup_stm32f10x_ld.s

     文件      13656  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\arm\startup_stm32f10x_ld_vl.s

     文件      12765  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\arm\startup_stm32f10x_md.s

     文件      14073  2011-03-10 10:51  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\arm\startup_stm32f10x_md_vl.s

     文件      15955  2011-03-10 10:51  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\arm\startup_stm32f10x_xl.s

     文件      13072  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\gcc_ride7\startup_stm32f10x_cl.s

     文件      13160  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\gcc_ride7\startup_stm32f10x_hd.s

     文件      12482  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\gcc_ride7\startup_stm32f10x_hd_vl.s

     文件       9814  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\gcc_ride7\startup_stm32f10x_ld.s

     文件      10562  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\gcc_ride7\startup_stm32f10x_ld_vl.s

     文件      10269  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\gcc_ride7\startup_stm32f10x_md.s

     文件      11058  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\gcc_ride7\startup_stm32f10x_md_vl.s

     文件      13261  2011-03-10 10:52  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\gcc_ride7\startup_stm32f10x_xl.s

     文件      16626  2011-03-10 10:53  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\iar\startup_stm32f10x_cl.s

     文件      16229  2011-03-10 10:53  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\iar\startup_stm32f10x_hd.s

     文件      15675  2011-03-10 10:53  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\iar\startup_stm32f10x_hd_vl.s

     文件      12650  2011-03-10 10:53  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\iar\startup_stm32f10x_ld.s

     文件      12950  2011-03-10 10:53  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\iar\startup_stm32f10x_ld_vl.s

     文件      12912  2011-03-10 10:53  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\iar\startup_stm32f10x_md.s

     文件      13601  2011-03-10 10:53  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\iar\startup_stm32f10x_md_vl.s

     文件      16628  2011-03-10 10:53  倒立摆 PID双环\旋转倒立摆\Libraries\CMSIS\CM3\DeviceSupport\ST\STM32F10x\startup\iar\startup_stm32f10x_xl.s

............此处省略301个文件信息