《舵机控制原理.doc》由会员分享，可在线阅读，更多相关《舵机控制原理.doc（4页珍藏版）》请在金锄头文库上搜索。
1、;*; SL-DIY-02-1 通用伺服电机(舵机)实验; 通用伺服电机(舵机)来回摆动基本工作原理; 当单片机信号是1ms正脉冲时,通用伺服电机转向0度位置; 当单片机信号是1.5ms正脉冲时,通用伺服电机转向-60度位置; 当单片机信号是2ms正脉冲时,通用伺服电机转向+60度位置; 注意:不同伺服电机控制时序及转动角度是不同的,最好自已实际测试。; 不同伺服电机控制速度指标也不同,应按技术说明书研究处理。;*;* AT90S8515 8MHz ;* PB0 输出舵机信号;* 双龙电子 ;* 2002.12.20修改;* SLLG *;*.include 8515def.inc; 器件配制
2、文件, 本实验使用AT90S8515.def dt = r22; 定义dt等于r22.org$000; 程序首地址rjmpreset4; 跳过中断区.org$010; 主程序首地址,注意,不同器件的中断地址范围是不同的!reset4:ldi r17,$02;置堆栈指针,AT90S8515的RAM最大地址为$025F, 设堆栈底为$025Fldi r16,$5fout sph,r17; 高位堆栈sph=$02out spl,r16; 低位堆栈spl=$5fshiyan4:ldi r17,$ffout ddrb,r17; pb口方向寄存器设置为输出,1为输出out portb,r17; 设pb口内
3、部上拉out ddrd,r17; pd口方向寄存器设置为输出,1为输出out portd,r17 ; 设pd口内部上拉start3:; 设置舵机摆动周期常数, 即调节节拍常数LDI R23,$11LDI R25,$11 ;R23=R25=$50摆动周期1S; 如=$30摆动周期0.5S; 如=20-10摆动周期, 也可理解为调节拍范围 ;$8强劲舞曲 ; $18 男儿当自强 ;$11 少年梦 ; 可作自唱自演跳舞机器人设计用。start6:; 舵机向-60度方向移动sbi$18,0; 置pb.0为1rcallde10;1ms,-60度cbi$18,0; 清pb.0为0rcallde10;1ms
4、,-60度 rcallde185;19msDECR23;R23-1CPI R23,$01;R23 与立即数$01比较BRSHstart6;大于等于则转移到, 小于顺序执行rcallde200; 调用2ms延时程序start60:; 舵机向+60度方向移动sbi$18,0; 置pb.0为1rcallde20;2ms,+60度cbi$18,0; 清pb.0为0rcallde20; 调用2ms,+60度 rcallde18; 调用18msDECR25;R25-1CPI R25,$01; ;R25 与立即数$01比较BRSHstart60;大于等于则转移到, 小于顺序执行rcallde200 ; 调用
5、20msrjmpstart3;循环检测de10:; 1ms延时子程序ldidt,21;1msrcalldelay; 调用通用延时子程序ret; 子程序返回de15:; 1.5ms延时子程序ldidt,26;1.5msrcalldelay; 调用通用延时子程序 ret; 子程序返回de20:; 2ms延时子程序ldidt,28;2msrcalldelay; 调用通用延时子程序ret; 子程序返回de18:; 18ms延时子程序ldidt,63 ;18msrcalldelay; 调用通用延时子程序ret; 子程序返回de185: ; 19ms延时子程序ldidt,64;18.8msrcalldel
6、ay; 调用通用延时子程序ret; 子程序返回de19:; 20ms延时子程序ldidt,65;19.6msrcalldelay; 调用通用延时子程序ret; 子程序返回de200:;20ms延时子程序ldidt,50 ;2ms,DT=100-10无多大变化rcalldelay; 调用通用延时子程序ret; 子程序返回;延时时间对照表;*;fos=8MHz;dt time dt time dt time;22 1ms 26 1.5ms 29 2ms;51 10ms 63 18ms 64 18.8ms;65 19.6ms 144 200ms 197 500ms;249 1s;*delay:; 通
7、用延时子程, 子程序2级嵌套 push dt; 进栈,需2tdel1:push dt; 进栈,需2tdel2:push dt; 进栈,需2tdel3:dec dt; dt-1,需1tbrnedel3; 上条指令执行后Z=0转, Z=1顺执, 需1t/2tpop dt; 出栈, 需2tdec dt; dt-1,需1tbrnedel2; 上条指令执行后Z=0转, Z=1顺执, 需1t/2tpop dt; 出栈, 需2tdec dt; dt-1,需1tbrnedel1; 上条指令执行后Z=0转, Z=1顺执, 需1t/2tpop dt; 出栈, 需2tret; 子程序返回, 需4t广州市天河双龙电子有限公司 http:/WWW.SL.COM.CN广州双龙:广州天河路561号新赛格电子城331室(510630) 电话:020-87578852、87505012 传真:分机620北京双龙:北京海淀知春路132号中发大厦616室(100086) 电话:010-82623551、62653785 传真:010-82623550上海双龙:上海北京东路668号科技京城东搂12H2室(200001) 电话:021-53081501 、53081502 传真:分机213
