Command_Z80

    MCX0L   equ 060H    ; Command register Lo
    MCX0H   equ 061H    ; Command register Hi
    MCX6L   equ 06CH    ; Read/Write register Lo
    MCX6H   equ 06DH    ; Read/Write register Hi
    MCX7L   equ 06EH    ; Read/Write register Lo
    MCX7H   equ 07FH    ; Read/Write register Hi

SETOUTPUTPLS:
    LD  HL,0000H
    LD  BC,MCX7H
    OUT (C),H
    LD  BC,MCX7L
    OUT (C),L

    LD  HL,1000     ; 1000Pulse
    LD  BC,MCX6H
    OUT (C),H
    LD  BC,MCX6L
    OUT (C),L

    LD  HL,006H     ; PLS Set command
    LD  BC,MCX0H
    OUT (C),H
    LD  BC,MCX0L
    OUT (C),L

    LD  HL,020H     ; Drive command
    LD  BC,MCX0H
    OUT (C),H
    LD  BC,MCX0L
    OUT (C),L

    RET