舵機

舵機驅動信號

#include "stm32f10x.h"                  // Device header
#include "OLED.h"
#include "EncoderAndServo.h"
#include "Delay.h"


int main()
{
        int32_t i ;
        uint16_t Angle,KeyNum=0;
        OLED_Init();
        EncoderAndServo_Init();
        OLED_DisplayString(1,1,"Angle:");
        while(1)
        {
                i+=Return_Num();//獲取編碼器返回值
                if(Return_KeyNum())//判斷編碼器按鍵是否按下
                {
                        i+=50;
                }
                if(i>250)i=50;
                if(i<50)i=50;

                Angle=i;
                TIM3_SetCompare((uint16_t)i);//將i傳遞給捕獲比較寄存器
                OLED_DisplayNum(1,7,(uint16_t)((((float)Angle-50.0)/200.0)*180.0),3);//角度顯示

        }               
}