#技术风云榜#matlab机器人 单片机控制舵机测试程序

ededewa

#include "reg52.h"
$ P" C+ Q: O3 M5 ]) y#define uchar unsigned char  
/ i; q3 y. n: g8 w$ w* V#define uint unsigned int  
sbit    P2_0 = P2^0;
sbit    P2_1 = P2^1;
) b4 n$ X' v/ u  q+ S+ nsbit    P2_2 = P2^2;
5 U/ Q- a" b$ J. Gsbit   P2_7 = P2^7;
' G- \7 ?. e/ a: N2 _6 D$ H) P/*delay(1)延时时间为300US
9 j0 v* X: X/ Y2 V7 z3 tdelay(80)延时时间为20mS
$ ~3 R5 X# E: ndelay(4)延时时间为1mS
delay(8)延时时间为2mS
7 ]/ n  I# u  l2 }+ P9 e+ Odelay(6)延时时间为1.55mS
delay(2)延时时间为0.55MS
1 z! N0 j; ]; ]2 Gdelay(10)延时时间为2.5mS
0 J: j/ h0 n8 `* J$ R5 ~9 ]$ i' f*/
' I2 ?7 a- f( pvoid Delay(int j)   //延时
    {      int i;
        for(;j>0;j--)
       {
' B$ V. x$ }7 k; L; D         for(i=0;i<28;i++);
' I  N$ ?8 @. g$ y% Z' r, s/ P          }
    }

, P1 m+ g- M! N0 w: n. K% Mvoid main(void)
% _! g, r- z+ b0 q{
          int i=0;
$ _* A0 K# ^4 p2 E          int j=0;
$ ?: c# h- u  Y3 O          int g=0;
* R7 R" e3 P* W8 @2 o3 ~          P2=0XFF;
            P2_0=0;             //舵机电源地线
            P2_1 =1;   //舵机电源电压    注意 这两个 引脚要和单片机 电源电压和地线 共线 ，不然会出现舵机只按一个方向转
6 z0 K- g( p& \1 T+ x3 g' Y            P2_2=0;   // 控制脉宽         
% t+ _8 f8 y' r( a, s  while(1)
7 S; N* o' `. r7 ]# C' m5 v       {  for(g=0;g<25;g++)   //0.5ms 0度位置
% i7 B3 b2 y9 g6 s* [                {
' p8 m4 j" Z, U2 N                   P2_7=0;  //开启P2_7灯
                    P2_2=1;
                     Delay(2);
# K: j. m. [* N' h                    P2_2=0;
                  Delay(78);
: Y) m  N' A' D+ ~5 r6 K% G                   Delay(100);
               }
4 N; O0 }( o! F           Delay(5000);
( _$ |3 f/ ~7 r            P2_7=1;  //结束P2_7灯
          //1.0ms   45度位置
, O1 ^8 t9 l1 J/ f4 n8 A      for(g=0;g<15;g++)
            { P2_2=1;
              Delay(4);
8 c5 Z$ z; ]1 p& G- I# u5 d1 q  ]               P2_2=0;
8 Y8 T8 U8 x0 ^; C3 L               Delay(78);
             Delay(100);
# t- B6 [$ x' `' Q" v- ^6 Z           }
. K: b/ V/ U5 a3 c  //1.5ms   90度位置
      for(g=0;g<15;g++)
       {   P2_2=1;
            Delay(6);
             P2_2=0;
! x- B0 n9 z0 c                Delay(78);
3 x& r- F# \- x  {               Delay(100);
         }
) t7 p5 X. F2 P6 K& c: {7 z; S  //2.0ms   135度位置
    for(g=0;g<15;g++)
         {   P2_2=1;
              Delay(8);
              P2_2=0;
/ G' \) |3 v7 p- i6 }3 q( @              Delay(74);
3 ]( P* n5 [9 P3 J$ ^  C              Delay(100);
         }
  // 2.5ms   180度位置
% k/ @( z. u( {1 z6 V+ V' F  for(g=0;g<15;g++)
) D0 V& I: r  Y  E9 k        { P2_2=1;
          Delay(10);
, D+ R# `7 [7 V) y           P2_2=0;
           Delay(72);
           Delay(100);
; R4 ^8 g: _: G5 K+ E          }
/ c7 W, \/ O! w, k$ E' L" G1 b6 m
    }
}

younicp

matlab机器人 单片机控制舵机测试程序