以下是使用機器人用的S35STD伺服馬達的遙控自走車程式片段
*********************************************************
MOTORGOF: ;車子退後副程式
SETB MOTOR1 ;把MOTOR1設為1(此為伺服馬達控制方法)
SETB MOTOR2 ;把MOTOR2設為1(此為伺服馬達控制方法)
MOV R5,#GOFORWARD ;把GOFORWARD常數丟到R5
CALL S_DELAY ;短時間DELAY
CLR MOTOR2 ;把MOTOR2設為0(此為伺服馬達控制方法)
MOV R5,#(GOBACK-GOFORWARD) ;把GOBACK-GOFORWARD常數丟到R5
CALL S_DELAY ;短時間DELAY
CLR MOTOR1 ;把MOTOR1設為0(此為伺服馬達控制方法)
MOV R5,#(200-GOBACK) ;把200-GOBACK常數丟到R5
CALL S_DELAY ;短時間DELAY
DJNZ R0,MOTORGOF
RET ;離開副程式
;----------------------------------------------------------
MOTORGOB: ;車子前進副程式
SETB MOTOR1 ;把MOTOR1設為1(此為伺服馬達控制方法)
SETB MOTOR2 ;把MOTOR1設為1(此為伺服馬達控制方法)
MOV R5,#GOFORWARD ;把GOFORWARD常數丟到R5
CALL S_DELAY ;短時間DELAY
CLR MOTOR1 ;把MOTOR1設為0(此為 ..

訪客只能看到部份內容，免費 加入會員 或由臉書 Google 可以看到全部內容