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

ededewa

#include "reg52.h"
#define uchar unsigned char  
  a3 v3 d  Y, i, y4 Y, O3 ]#define uint unsigned int  
sbit    P2_0 = P2^0;
sbit    P2_1 = P2^1;
) P7 e/ |2 k, J- q  y/ W) osbit    P2_2 = P2^2;
, q6 h( j# w1 N. {# e) R5 |sbit   P2_7 = P2^7;
/*delay(1)延时时间为300US
8 j! _  q. L$ P. \5 Ndelay(80)延时时间为20mS
delay(4)延时时间为1mS
6 a* ~; I8 P6 R% [! udelay(8)延时时间为2mS
delay(6)延时时间为1.55mS
delay(2)延时时间为0.55MS
! {7 a3 j# `' q7 _( R3 B& n. u% jdelay(10)延时时间为2.5mS
*/
0 S  n: Q- _1 I5 m  Kvoid Delay(int j)   //延时
    {      int i;
        for(;j>0;j--)
2 u; ^3 K$ @7 R+ |: G3 q5 P) }       {
         for(i=0;i<28;i++);
          }
9 V4 L2 H6 l. `    }
8 E9 A3 i* `% ~( Q! m
void main(void)
7 H. A9 M* u, C9 N$ ~{
- L9 j7 D8 g0 n( B) v          int i=0;
2 Y+ h0 ]. K& q/ y& N" p          int j=0;
          int g=0;
          P2=0XFF;
7 u- H! X% I) }            P2_0=0;             //舵机电源地线
. t0 ]* }) Z4 M; |' d; H            P2_1 =1;   //舵机电源电压    注意 这两个 引脚要和单片机 电源电压和地线 共线 ，不然会出现舵机只按一个方向转
, n( o& Z  P$ o3 V! B3 A9 n: @/ V& W$ _            P2_2=0;   // 控制脉宽         
  while(1)
       {  for(g=0;g<25;g++)   //0.5ms 0度位置
% b" L7 ^$ a. b: [7 J( Z                {
- S7 n2 E1 B0 {0 C                   P2_7=0;  //开启P2_7灯
0 U, q! `  D0 F/ p& Y2 r7 h3 f/ S                    P2_2=1;
1 A4 W: D7 @$ m# K                     Delay(2);
                    P2_2=0;
                  Delay(78);
' h6 f6 y7 c& [1 d" p! X1 C                   Delay(100);
               }
           Delay(5000);
            P2_7=1;  //结束P2_7灯
          //1.0ms   45度位置
. I' F5 Y7 c% w      for(g=0;g<15;g++)
            { P2_2=1;
6 q7 X7 l! _: ]              Delay(4);
8 v1 ~6 i9 l$ v, s               P2_2=0;
               Delay(78);
' x7 s# `! Z8 H& c4 p             Delay(100);
( _! i# b9 T  N; X           }
! w" X+ @, T+ `0 K  A7 C3 F  //1.5ms   90度位置
      for(g=0;g<15;g++)
       {   P2_2=1;
            Delay(6);
% l+ s. y: B: g2 W! U: S             P2_2=0;
                Delay(78);
               Delay(100);
         }
  //2.0ms   135度位置
! x' S9 g2 }$ w$ j2 l    for(g=0;g<15;g++)
) V; g: B8 S4 d9 g         {   P2_2=1;
1 D9 K4 P; R1 X, ^& g9 @              Delay(8);
* C0 x, M% ]* U0 S. m; R2 }              P2_2=0;
+ @% Z8 v1 ^3 G              Delay(74);
. B7 \( r$ @2 Z& m2 h$ u              Delay(100);
         }
1 Z' O; G. y/ ]+ D, q" c+ F  // 2.5ms   180度位置
9 Y, P$ y2 u& M  for(g=0;g<15;g++)
        { P2_2=1;
          Delay(10);
4 o- L$ f1 k  h$ j) C' l           P2_2=0;
# h' I# J6 e3 j% L. s5 A& |0 V" B           Delay(72);
           Delay(100);
          }

    }
}
4 i% J' W" ^4 f+ {- a

younicp

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