incdir "include:"
    include "rtgmaster/rtgc2p.i"
    include "rtgmaster/rtgmaster.i"
    include "rtgmaster/rtgsublibs.i"
    include "rtgmaster/rtgAMI.i"
    include "intuition/screens.i"
    include "exec/memory.i"
    moveq #0,d0
    rts
.s  dc.l "c2p!"
    dc.l .s
    dc.l 1
    dc.l Structure

Structure
    dc.w CI_256+CI_128+CI_64+CI_32+CI_16+CI_8+CI_4+CI_2+CI_EHB
    dc.w CI_68060D+CI_68040+CI_68030D+CI_68020D
    dc.w 0
    dc.b 0
    dc.b 0
    dc.l c2p_1x1
    dc.w 320
    dc.w 200
    dc.w CI_Fixed+CI_Destruct
    dc.b 'AMI '
    dc.l Name
    dc.l Init
    dc.l Expunge
    dc.l chunky2planar
    dc.l 0
    dc.l 0
    dc.l 0
    dc.b 0
    dc.b 0,0,0 ; Test
    even

Init:
    movem.l a0/a1/a6/d0/d1,-(sp)
    move.l #0,rs_c2pdata(a0)
    movem.l (sp)+,a0/a1/a6/d0/d1
    move.l #0,d0
    rts
Error:
Name: dc.b 'c2p for 020 with 320x200 *ONLY*',0
    even

Expunge:
    rts

chunky2planar:
                movem.l d0/d3/a3/d7,-(sp)
                move.l #0,d7
                cmp.l #c2p_1x1,d0
                beq .OK
                cmp.l #c2p_Best,d0
                beq .OK
                cmp.l #c2p_BestD,d0
                beq .OK
                cmp.l #c2p_Fastest,d0
                beq .OK
                cmp.l #c2p_FastestD,d0
                beq .OK
                cmp.l #c2p_Selected,d0
                beq .Selected
                cmp.l #c2p_SelectedD,d0
                beq .Selected
                move.l #c2p_warn_Wrong_Pixelmode,d7
                bra .OK
.Selected:
                move.l rs_c2pcurr(a3),d3
                cmp.l #c2p_1x1,d3
                beq .OK
                move.l #c2p_warn_Wrong_Pixelmode,d7
                bra .OK
.OK:
                cmp.l #1,.Merk2
                beq .Mistake
                cmp.l #1,.Merk
                beq c2p
                move.l #1,.Merk
                move.l #0,.Merk2
                move.l a3,-(sp)
                move.l rsAMI_ScreenHandle(a3),a3
                cmp.w #320,sc_Width(a3)
                bne .Mistake
                cmp.w #200,sc_Height(a3)
                bne .Mistake
                move.l (sp)+,a3
                lea rsAMI_Bitmap1(a3),a3
                bra c2p
                move.l a3,-(sp)
                bra .Mistake
.Merk: dc.l 0
.Merk2: dc.l 0
.Mistake:
                move.l (sp)+,a3
                move.l #1,.Merk2
                movem.l (sp)+,d0/d3/a3/a7
                move.l d7,d0
                movem.l d2/a6,-(sp)
                move.l $4,a6
                move.l #0,a1
                jsr -294(a6)
                move.l d0,a1
                movem.l (sp)+,d0/a6
                move.l a6,-(sp)
                move.l $4,a6
                move.l d0,d1
                sub.l d0,d0
                bset d1,d0
                jsr -324(a6)
                move.l (sp)+,a6
                move.l #c2p_err_internal,d0
                rts

width           equ     320             ; must be multiple of 32
height          equ     200
plsiz           equ     (width/8)*height

c2p:
_chunky2planar:
                ;a0 = chunky buffer
                ;a1 = first bitplane

        movem.l d2-d7/a2-a6,-(sp)
        move.l  a0,a2
        add.l   #plsiz*8,a2     ;a2 = end of chunky buffer

        ;; Sweep thru the whole chunky data once,
        ;; Performing 3 merge operations on it.

        move.l  #$00ff00ff,a3   ; load byte merge mask
        move.l  #$0f0f0f0f,a4   ; load nibble merge mask

firstsweep
 movem.l (a0),d0-d7      ;8+4n   40      cycles
 move.l  d4,a6           a6 = CD
 move.w  d0,d4           d4 = CB
 swap    d4              d4 = BC
 move.w  d4,d0           d0 = AC
 move.w  a6,d4           d4 = BD
 move.l  d5,a6           a6 = CD
 move.w  d1,d5           d5 = CB
 swap    d5              d5 = BC
 move.w  d5,d1           d1 = AC
 move.w  a6,d5           d5 = BD
 move.l  d6,a6           a6 = CD
 move.w  d2,d6           d6 = CB
 swap    d6              d6 = BC
 move.w  d6,d2           d2 = AC
 move.w  a6,d6           d6 = BD
 move.l  d7,a6           a6 = CD
 move.w  d3,d7           d7 = CB
 swap    d7              d7 = BC
 move.w  d7,d3           d3 = AC
 move.w  a6,d7           d7 = BD
 move.l  d7,a6
 move.l  d6,a5
 move.l  a3,d6   ; d6 = 0x0x
 move.l  a3,d7   ; d7 = 0x0x
 and.l   d0,d6   ; d6 = 0b0r
 and.l   d2,d7   ; d7 = 0j0z
 eor.l   d6,d0   ; d0 = a0q0
 eor.l   d7,d2   ; d2 = i0y0
 lsl.l   #8,d6   ; d6 = b0r0
 lsr.l   #8,d2   ; d2 = 0i0y
 or.l    d2,d0           ; d0 = aiqy
 or.l    d7,d6           ; d2 = bjrz
 move.l  a3,d7   ; d7 = 0x0x
 move.l  a3,d2   ; d2 = 0x0x
 and.l   d1,d7   ; d7 = 0b0r
 and.l   d3,d2   ; d2 = 0j0z
 eor.l   d7,d1   ; d1 = a0q0
 eor.l   d2,d3   ; d3 = i0y0
 lsl.l   #8,d7   ; d7 = b0r0
 lsr.l   #8,d3   ; d3 = 0i0y
 or.l    d3,d1           ; d1 = aiqy
 or.l    d2,d7           ; d3 = bjrz

 move.l  a4,d2   ; d2 = 0x0x
 move.l  a4,d3   ; d3 = 0x0x
 and.l   d0,d2   ; d2 = 0b0r
 and.l   d1,d3   ; d3 = 0j0z
 eor.l   d2,d0   ; d0 = a0q0
 eor.l   d3,d1   ; d1 = i0y0
 lsr.l   #4,d1   ; d1 = 0i0y
 or.l    d1,d0           ; d0 = aiqy
 move.l  d0,(a0)+
 lsl.l  #4,d2
 or.l    d3,d2           ; d1 = bjrz
 move.l d2,(a0)+

 move.l  a4,d3   ; d3 = 0x0x
 move.l  a4,d1   ; d1 = 0x0x
 and.l   d6,d3   ; d3 = 0b0r
 and.l   d7,d1   ; d1 = 0j0z
 eor.l   d3,d6   ; d6 = a0q0
 eor.l   d1,d7   ; d7 = i0y0
 lsr.l   #4,d7   ; d7 = 0i0y
 or.l    d7,d6           ; d6 = aiqy
 move.l d6,(a0)+
 lsl.l  #4,d3
 or.l    d1,d3           ; d7 = bjrz
 move.l d3,(a0)+

; move.l  d0,(a0)+
; move.l  d2,(a0)+
; move.l  d6,(a0)+
; move.l  d3,(a0)+
 move.l  a6,d7
 move.l  a5,d6
 move.l  a3,d0   ; d0 = 0x0x
 move.l  a3,d1   ; d1 = 0x0x
 and.l   d4,d0   ; d0 = 0b0r
 and.l   d6,d1   ; d1 = 0j0z
 eor.l   d0,d4   ; d4 = a0q0
 eor.l   d1,d6   ; d6 = i0y0
 lsl.l   #8,d0   ; d0 = b0r0
 lsr.l   #8,d6   ; d6 = 0i0y
 or.l    d6,d4           ; d4 = aiqy
 or.l    d1,d0           ; d6 = bjrz
 move.l  a3,d1   ; d1 = 0x0x
 move.l  a3,d6   ; d6 = 0x0x
 and.l   d5,d1   ; d1 = 0b0r
 and.l   d7,d6   ; d6 = 0j0z
 eor.l   d1,d5   ; d5 = a0q0
 eor.l   d6,d7   ; d7 = i0y0
 lsl.l   #8,d1   ; d1 = b0r0
 lsr.l   #8,d7   ; d7 = 0i0y
 or.l    d7,d5           ; d5 = aiqy
 or.l    d6,d1           ; d7 = bjrz
 move.l  a4,d6   ; d6 = 0x0x
 move.l  a4,d7   ; d7 = 0x0x
 and.l   d4,d6   ; d6 = 0b0r
 and.l   d5,d7   ; d7 = 0j0z
 eor.l   d6,d4   ; d4 = a0q0
 eor.l   d7,d5   ; d5 = i0y0
 lsr.l   #4,d5   ; d5 = 0i0y
 or.l    d5,d4           ; d4 = aiqy
 move.l  d4,(a0)+
 lsl.l   #4,d6   ; d6 = b0r0
 or.l    d7,d6           ; d5 = bjrz
 move.l  d6,(a0)+

 move.l  a4,d7   ; d7 = 0x0x
 move.l  a4,d5   ; d5 = 0x0x
 and.l   d0,d7   ; d7 = 0b0r
 and.l   d1,d5   ; d5 = 0j0z
 eor.l   d7,d0   ; d0 = a0q0
 eor.l   d5,d1   ; d1 = i0y0
 lsr.l   #4,d1   ; d1 = 0i0y
 or.l    d1,d0           ; d0 = aiqy
 move.l  d0,(a0)+
 lsl.l   #4,d7   ; d7 = b0r0
 or.l    d5,d7           ; d1 = bjrz
 move.l  d7,(a0)+
 cmp.l   a0,a2           ;; 4c
 bne.w   firstsweep      ;; 6c

 sub.l   #plsiz*8,a0
 move.l  #$33333333,a5
 move.l  #$55555555,a6
 lea     plsiz*4(a1),a1  ;a2 = plane4

secondsweep
 move.l  (a0),d0
 move.l  8(a0),d1
 move.l  16(a0),d2
 move.l  24(a0),d3

 move.l  a5,d6   ; d6 = 0x0x
 move.l  a5,d7   ; d7 = 0x0x
 and.l   d0,d6   ; d6 = 0b0r
 and.l   d2,d7   ; d7 = 0j0z
 eor.l   d6,d0   ; d0 = a0q0
 eor.l   d7,d2   ; d2 = i0y0
 lsl.l   #2,d6   ; d6 = b0r0
 lsr.l   #2,d2   ; d2 = 0i0y
 or.l    d2,d0           ; d0 = aiqy
 or.l    d7,d6           ; d2 = bjrz
 move.l  a5,d7   ; d7 = 0x0x
 move.l  a5,d2   ; d2 = 0x0x
 and.l   d1,d7   ; d7 = 0b0r
 and.l   d3,d2   ; d2 = 0j0z
 eor.l   d7,d1   ; d1 = a0q0
 eor.l   d2,d3   ; d3 = i0y0
 lsl.l   #2,d7   ; d7 = b0r0
 lsr.l   #2,d3   ; d3 = 0i0y
 or.l    d3,d1           ; d1 = aiqy
 or.l    d2,d7           ; d3 = bjrz
 move.l  a6,d2   ; d2 = 0x0x
 move.l  a6,d3   ; d3 = 0x0x
 and.l   d0,d2   ; d2 = 0b0r
 and.l   d1,d3   ; d3 = 0j0z
 eor.l   d2,d0   ; d0 = a0q0
 eor.l   d3,d1   ; d1 = i0y0
 lsr.l   #1,d1   ; d1 = 0i0y
 or.l    d1,d0           ; d0 = aiqy
 move.l  d0,plsiz*3(a1)
 add.l   d2,d2
 or.l    d3,d2           ; d1 = bjrz
 move.l  d2,plsiz*2(a1)

 move.l  a6,d3   ; d3 = 0x0x
 move.l  a6,d1   ; d1 = 0x0x
 and.l   d6,d3   ; d3 = 0b0r
 and.l   d7,d1   ; d1 = 0j0z
 eor.l   d3,d6   ; d6 = a0q0
 eor.l   d1,d7   ; d7 = i0y0
 lsr.l   #1,d7   ; d7 = 0i0y
 or.l    d7,d6           ; d6 = aiqy
 move.l  d6,plsiz*1(a1)
 add.l   d3,d3
 or.l    d1,d3           ; d7 = bjrz
 move.l  d3,(a1)+

 move.l  4(a0),d0
 move.l  12(a0),d1
 move.l  20(a0),d2
 move.l  28(a0),d3

 move.l  a5,d6   ; d6 = 0x0x
 move.l  a5,d7   ; d7 = 0x0x
 and.l   d0,d6   ; d6 = 0b0r
 and.l   d2,d7   ; d7 = 0j0z
 eor.l   d6,d0   ; d0 = a0q0
 eor.l   d7,d2   ; d2 = i0y0
 lsl.l   #2,d6   ; d6 = b0r0
 lsr.l   #2,d2   ; d2 = 0i0y
 or.l    d2,d0           ; d0 = aiqy
 or.l    d7,d6           ; d2 = bjrz
 move.l  a5,d7   ; d7 = 0x0x
 move.l  a5,d2   ; d2 = 0x0x
 and.l   d1,d7   ; d7 = 0b0r
 and.l   d3,d2   ; d2 = 0j0z
 eor.l   d7,d1   ; d1 = a0q0
 eor.l   d2,d3   ; d3 = i0y0
 lsl.l   #2,d7   ; d7 = b0r0
 lsr.l   #2,d3   ; d3 = 0i0y
 or.l    d3,d1           ; d1 = aiqy
 or.l    d2,d7           ; d3 = bjrz
 move.l  a6,d2   ; d2 = 0x0x
 move.l  a6,d3   ; d3 = 0x0x
 and.l   d0,d2   ; d2 = 0b0r
 and.l   d1,d3   ; d3 = 0j0z
 eor.l   d2,d0   ; d0 = a0q0
 eor.l   d3,d1   ; d1 = i0y0
 lsr.l   #1,d1   ; d1 = 0i0y
 or.l    d1,d0           ; d0 = aiqy
 move.l  d0,-4-plsiz*1(a1)
 add.l   d2,d2
 or.l    d3,d2           ; d1 = bjrz
 move.l  d2,-4-plsiz*2(a1)

 move.l  a6,d3   ; d3 = 0x0x
 move.l  a6,d1   ; d1 = 0x0x
 and.l   d6,d3   ; d3 = 0b0r
 and.l   d7,d1   ; d1 = 0j0z
 eor.l   d3,d6   ; d6 = a0q0
 eor.l   d1,d7   ; d7 = i0y0
 lsr.l   #1,d7   ; d7 = 0i0y
 or.l    d7,d6           ; d6 = aiqy
 move.l  d6,-4-plsiz*3(a1)
 add.l   d3,d3
 or.l    d1,d3           ; d7 = bjrz
 move.l  d3,-4-plsiz*4(a1)
 add.w   #32,a0  ;;4c
 cmp.l   a0,a2   ;;4c
 bne.w   secondsweep     ;;6c

        ;300

exit
        movem.l (sp)+,d2-d7/a2-a6



Raus:

                move.l d7,d0
                movem.l (sp)+,d0/d3/a3/d7
                movem.l d2/a6,-(sp)
                move.l $4,a6
                move.l #0,a1
                jsr -294(a6)
                move.l d0,a1
                movem.l (sp)+,d0/a6
                move.l a6,-(sp)
                move.l $4,a6
                move.l d0,d1
                sub.l d0,d0
                bset d1,d0
                jsr -324(a6)
                move.l (sp)+,a6
                move.l #0,d0
                rts

                cnop    0,4

    END