?? print.asm
字號:
pop ax
br $Cm_hp_here_wait ;HP為低中的情況2
Cm_hp_here:
movw cm_step_num,#12 ;HP為低中的情況1 移12步
Cm_hp_here_wait:
cmp cm_init_flag,#MOTOR_IDLE
bne $Cm_hp_here_wait ;循環等待
Cm_init_left:
movw cm_step_num,#52
mov cm_rush_flag,#MOTOR_RUSH_STATE ;MOTOR_HOLD_STATE=000H ;保持狀態
;MOTOR_RUSH_STATE=001H ;rush狀態
;MOTOR_DRIVE_STATE=011H ;驅動狀態
mov cm_init_flag,#MOTOR_INIT
mov cm_dir_flag,#MOTOR_DIR_L_OR_B
mov db_10Step12SwitchFlag,#DB_12STEP
mov cm_step_counter,#12
mov cm_speed_state,#MOTOR_SPEED_ACC
call timer20_init ;hp信號為高,向走左no more than 49步
Cm_init_left_wait_0:
cmp cm_init_flag,#MOTOR_IDLE
bne $Cm_init_left_wait_0 ;由Timer2中斷完成加－勻－減速過程
call hp_signal
bnc $Cm_init_last
mov print_return_value,#PRNT_HP_ERR
ret ;停下還 hp signal高則還回硬件錯誤
Cm_init_last:
movw cm_step_num,#65
mov cm_rush_flag,#MOTOR_RUSH_STATE
mov cm_init_flag,#MOTOR_INIT
mov cm_dir_flag,#MOTOR_DIR_R_OR_F
mov db_10Step12SwitchFlag,#DB_12STEP
mov cm_step_counter,#12
mov cm_speed_state,#MOTOR_SPEED_ACC
call timer20_init ;最后走52步
Cm_init_last_wait:
cmp cm_speed_state,#MOTOR_SPEED_CONST
bne $Cm_init_last_wait1
call hp_signal
bnc $Cm_init_last_wait1
br $Cm_init_hp_here1 ;遇HP高
Cm_init_last_wait1:
cmp cm_init_flag,#MOTOR_IDLE
bne $Cm_init_last_wait
mov print_return_value,#PRNT_HP_ERR
ret ;停下還 hp signal低則還回硬件錯誤
Cm_init_hp_here1:
movw cm_step_num,#10 ;遇HP高移10steps
Cm_init_hp_here1_wait:
cmp cm_init_flag,#MOTOR_IDLE
bne $Cm_init_hp_here1_wait
movw stop_position,#478
cmp db_PaperWideFlag,#PAPER_WIDE_57
bne $Cm_init_init_end
movw stop_position,#358 ;HP初始化結束
Cm_init_init_end:
call cm_move_in_centre
ret
;******************************************************************************
; 函數名：
; cm_move_in_centre
;
; 功能：
; 字車走到中間位置
;-------------------------------------------------------------------------------
cm_move_in_centre:
cmp cm_init_flag,#MOTOR_IDLE
bne $cm_move_in_centre ;等車停止
cm_move_in_centre_0:
movw ax,#228
cmp db_PaperWideFlag,#PAPER_WIDE_57
be $cm_move_in_centre_00 ;57mm
movw ax,#268 ;76mm 總步數268×2 紙類型不同中間位置就不一樣
cm_move_in_centre_00:
movw bc,ax
cmpw stop_position,ax
bl $cm_move_in_centre_01
bh $cm_move_in_centre_02
br $!cm_move_in_centre_exit ;字車當前停止位置與中間位置的比較
cm_move_in_centre_01:
mov cm_dir_flag,#MOTOR_DIR_R_OR_F
subw ax,stop_position
incw ax ;奇數補償
shrw ax,1
movw cm_idle_num,ax
br $!cm_move_in_centre_03 ;S<centre 向右走
cm_move_in_centre_02:
mov cm_dir_flag,#MOTOR_DIR_L_OR_B
subw stop_position,ax ; stop_position-ax -> stop_position
movw ax,stop_position ;stop_position -> ax
incw ax ;ax++
shrw ax,1 ;ax/2 ->ax
movw cm_idle_num,ax ;S>centre 向右走
cm_move_in_centre_03:
mov cm_speed_state,#MOTOR_SPEED_LOW
cmpw cm_idle_num,#24
bnh $cm_move_in_centre_04
subw cm_idle_num,#24
mov cm_speed_state,#MOTOR_SPEED_ACC
cm_move_in_centre_04:
mov cm_logic_flag,#01h
movw stop_position,bc
call start_cm_motor
cm_move_in_centre_exit:
ret
;******************************************************************************
; 函數名：
; start_cm_motor
;
; 功能：
; 啟動字車電機
;-------------------------------------------------------------------------------
start_cm_motor:
mov cm_rush_flag,#MOTOR_RUSH_STATE
mov cm_init_flag,#MOTOR_WORK
mov cm_step_counter,#12
cmp cm_logic_flag,#00h
bne $start_cm_motor_1
mov cm_speed_state,#MOTOR_SPEED_ACC
start_cm_motor_1:
call timer20_init
ret ;input cm_step_num,cm_dir_flag 步輻，方向
;******************************************************************************
; 函數名：
; timer20_int
;
; 功能：
; timer20中斷，處理字車和出針
;
;-------------------------------------------------------------------------------
timer20_int:
call mos_on
call mos_off
sel rb3 ;選擇3等級通用寄存器
cmp cm_init_flag,#MOTOR_INIT
be $cm_int_00 ;字車電機定位初始化
br $!cm_int_20 ;字車電機走動
cm_int_00:
cmp cm_rush_flag,#MOTOR_RUSH_STATE
bne $cm_rush_00
call cm_driver_current ;處于rush狀態
call cm_hold_current ;調用電流保護
call cm_driver_current
addw cr20W,#2ecch ;//rush時間為6ms
cmp cm_speed_state,#MOTOR_SPEED_STOP ;
bne $cm_rush_22
mov cm_rush_flag,#MOTOR_HOLD_STATE
br $!cm_int_end ;rush完后停止
cm_rush_22:
mov cm_rush_flag,#MOTOR_DRIVE_STATE
br $!cm_int_end ;rush完后驅動
cm_rush_00:
cmp cm_rush_flag,#MOTOR_DRIVE_STATE
be $cm_rush_01
call cm_hold_current
cmp feeding_flag,#MOTOR_WORK
be $cm_reserve_tm2_1
clr1 ce2
cm_reserve_tm2_1:
set1 cmk20 ;關中斷
mov cm_init_flag,#MOTOR_IDLE
br $!cm_int_end
cm_rush_01:
cmp cm_speed_state,#MOTOR_SPEED_LOW
bne $cm_speed_normal
addw cr20w,#2638h ;慢勻速移動 4.9ms
decw cm_step_num ;字車移動步數減1
cmpw cm_step_num,#00h
bne $cm_rush_32
mov cm_rush_flag,#MOTOR_RUSH_STATE
mov cm_speed_state,#MOTOR_SPEED_STOP ;慢速
cm_rush_32:
br $!cm_ph_exchange
cm_speed_normal:
cmp cm_speed_state,#MOTOR_SPEED_CONST
bne $cm_speed_normal_11
br $!cm_constant_move ;勻速
cm_speed_normal_11:
cmp cm_speed_state,#MOTOR_SPEED_ACC
bne $cm_decelerate_00
br $!cm_accelerate_tbl ;加速
cm_decelerate_00:
br $!cm_decelerate_tbl ;減速
CM_ACCELERATE_TIMER_TBL: dw 2638h,1268h,0EBDh,0CCAh
dw 0B9Fh,0AC3h,0A23h,09ACh
dw 0948h,08e4h,0830h,0830h
cm_accelerate_tbl: ;cm accelerate加速start （可以簡化）
push vvp ;vvp用于24位 ？？？WHL用于保存什么
push ax ;AX、HL、BC用于16位
push hl
push bc
movg vvp,#CM_ACCELERATE_TIMER_TBL
movw ax,#10
movw bc,#00h
cmp db_10Step12SwitchFlag,#DB_10STEP
bne $cm_12stepAccelerate
mov c,cm_step_counter
subw ax,bc
shlw ax,1 ;????????????
movw hl,ax
movw ax,[vvp+hl]
addw cr20w,ax
dec cm_step_counter
cmp cm_step_counter,#00h
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -