'Function Rgb2222(col)
'Local rR,rG,rB
'If col=1 Then rgb2222=0:Exit Function
' rR = (col% And &hff0000)>>22
' rG = (col% And &hff00)>>14
' rB = (col% And &hff)>>6
' rgb2222 = rgb222(rR,rG,rB)
'End Function

'Function RGB222(rrB,rrG,rrR) As integer
'possible lsb for transparency(XOR-mask)?,msb not in use at the moment
'Local res
' res=1   Or((rrR And 1)<<1)Or((rrR And 2)<<3)
' res=res Or((rrG And 1)<<2)Or((rrG And 2)<<4)
' res=res Or((rrB And 1)<<3)Or((rrB And 2)<<5)
' RGB222 = res
'End Function

'Input data &h00R0G0B0 (4bits each of RGB respectivly)
'Output data in 8 bits RGB222   xgrbgrb1 , xgrbgrb1 etc...
'Mask and shift the RGB data from 'col' to place the second MSB in position
'mask and Or it in place in Rgb2222, then shift the MSB into position
'mask and Or it in place, repeat for all 6 bits of the RGB222 data.
Function Rgb2222(col)
Local integer Rd,Gr,Bl
If col=1 Then rgb2222=0:Exit Function
Rd=(col And &hf00000)>>20
Gr=(col And &hf000)>>11
Bl=(col And &hf0)>>5
Rgb2222=1 Or(Bl And 2)Or(Bl And 4)<<2 Or(Rd And 4)Or(Rd And 8)<<2 Or(Gr And 8)Or(Gr And 16)<<2
End Function

Function Rgb2222(col)
Local Rd,Gr,Bl
If col=1 Then rgb2222=0:Exit Function
bl = (col And &hf00000)>>22
Gr = (col And &hf000)>>14
rd = (col And &hf0)>>6
Rgb2222=1 Or(Bl And 1)<<1 Or(Bl And 2)<<3 Or(Rd And 1)<<2 Or(Rd And 2)<<4 Or(Gr And 1)<<3 Or(Gr And 2)<<5
End Function

Sub DupD() 'DisplayUpDate
 Pack4Hub(HubPixs>>1) 'interchange and save in ringbuffer
End Sub

Sub Pack4Hub(size)
'twist and separate by bit-level Work()-data to PIO DMA TX-array(Pack())
Memory copy WAdr,UAdr,size     '01234560 for example bitnames at start
Memory copy VAdr,DAdr,size     '0ABCDEF0
Memory set pAdM,&b01110000,size'bit1:(MSB)01230000>>0+0ABC0000>>3->0123ABC0
Math c_AND Uppr(),AddM(),Tmp1()'mask first bits from up
Math c_AND Down(),AddM(),Tmp2()'mask first bits from down
Math shift Tmp2(),-3,Tmp2(),u  'unsigned shift down right!!!!!!
Math c_OR Tmp2(),Tmp1(),Tmp1() 'add up and down-temporary results
Math c_OR Tmp1(),Ad1M(),Tmp1() 'add EOLs and EOEs
Memory copy pTmp,pAA0,size     'copy bit1 part to ringbuffer
Memory set pAdM,&b00001110,size'bit0:(LSB)00004560<<3+0000DEF0>>3->0456DEF0
Math c_AND Uppr(),AddM(),Tmp1()'mask second bits from up
Math c_AND Down(),AddM(),Tmp2()'mask second bits from down
Math shift Tmp1(),3,Tmp1()     'shift them left
Math c_OR Tmp1(),Tmp2(),Tmp1() 'add up and down-temporary results
Math c_OR Tmp1(),Ad0M(),Tmp1() 'add EOLs and EOEs
Memory copy pTmp,pAA1,size     'copy bit0 part to ringbuffer
End Sub 'Pack4Hub()

if y > 63 then
 y= y-64
 x= x+128

Sub Pack4Hub(size)
size=size>>1

Sub mm.user_rectangle(x1,y1,x2,y2,col)
'Short cut for single pixle
If x1=x2 And y1=y2 Then
Memory set WAdr+(MM.VRES-y2-1)*MM.HRES+x1,rgb2222(col),1
Exit Sub
EndIf
'I hope you know what you do, coords outside screen will be skipped
'more tests will decrease speed
If x1<0 Or y1<0 Or x2>MM.HRES-1 Or y2>MM.VRES-1 Then Exit Sub

Local rC,rW,rH,rI,rBas

If x1>x2 Then rI=x2:x2=x1:x1=rI '18.Oct.25 note from Peter
If y1>y2 Then rI=y2:y2=y1:y1=rI 'the calling function did not sort!!!
rC=rgb2222(col)
rW=x2-x1+1
rH=y2-y1
rBas=WAdr+(MM.VRES-y2-1)*MM.HRES+x1
For rI=0 To rH
'  base-address + row*MM.HRES + x-pos,color,count(wide)
  Memory Set rBas+rI*MM.HRES,rC,rW
Next ' rI
'Print "Rec",x1,y1,x2,y2
End Sub

'These two variables need to be global now.
Dim Integer Rc,lcol=-1

Sub mm.user_rectangle(x1,y1,x2,y2,col)
'We only want the top 2 bits of first 3 bytes
col=col And &hC0C0C1
'Check if colour has changed
If lcol<>col Then
rC=rgb2222(col):lcol=col
EndIf
'Short cut for single pixle
If x1=x2 And y1=y2 Then
Memory set WAdr+(MM.VRES-y2-1)*MM.HRES+x1,rC,1:Exit Sub
EndIf
'I hope you know what you do, coords outside screen will be skipped
'more tests will decrease speed
If x1<0 Or y1<0 Or x2>MM.HRES-1 Or y2>MM.VRES-1 Then Exit Sub
'multi pixels here
Local rW,rH,rI,rBas
If x1>x2 Then rI=x2:x2=x1:x1=rI '18.Oct.25 note from Peter
If y1>y2 Then rI=y2:y2=y1:y1=rI 'the calling function did not sort!!!
rW=x2-x1+1
rH=y2-y1
rBas=WAdr+(MM.VRES-y2-1)*MM.HRES+x1
For rI=0 To rH
'  base-address + row*MM.HRES + x-pos,color,count(wide)
  Memory Set rBas+rI*MM.HRES,rC,rW
Next rI
End Sub

Sub DupD() 'DisplayUpDate
Local src0,src1,des0,stop
If HubStack >1 Then 'stacked->rearrange by copying to an other array
  src0=WAdr
  src1=Wadr+MM.VRES/2*MM.HRES
  des0=pSt0
  stop=src1
  Do loop
   Memory copy src1,des0,MM.HRES
    Inc src1,MM.HRES:Inc des0,MM.HRES
   Memory copy src0,des0,MM.HRES
    Inc src0,MM.HRES:Inc des0,MM.HRES
  until src0=stop 'src1 at start
  Pack4Hub(pSt0,pSt1,HubPixs>>1)
Else
  Pack4Hub(WAdr,VAdr,HubPixs>>1) 'interchange and save in ringbuffer
EndIf
End Sub

bYba=MM.VRES-y0-1          'calc outside loop
bMas=0                     'init val to read byte first
bI=bW*bH                   'all-count
bK=0:bM=0                  'init

Do This

bYba=MM.VRES-y0-1'          calc outside loop
bMas=0'                     init val to read byte first
bI=bW*bH'                   all-count
bK=0:bM=0'                  init

 Next i
Next j

Do this

 Next 'i
Next 'j

If lcol<>col Then rC=rgb2222(col):lcol=col
If (x1=x2)And(y1=y2)Then Memory set WAdr+(MM.VRES-y1-1)*MM.HRES+x1,rC,1:Exit Sub

Sub StripeMoveLeft(slY0,slY1)'area
Local slT,sWid=MM.HRES,sDec=sWid-1
If slY0>slY1 Then slT=slY1:slY1=slY0:slY0=slT
Local sSrc=WAdr+slY0*sWid,sEnd=WAdr+slY1*sWid
For slT=sSrc To sEnd Step sWid:Memory copy slT+1,slT,sDec
Next ' slY
End Sub

Sub StripeMoveRight(srY0,srY1)'area
Local srT,sWid=MM.HRES,sDec=sWid-1
If srY0>srY1 Then srT=srY1:srY1=srY0:srY0=srT
Local sSrc=WAdr+srY0*sWid,sEnd=WAdr+srY1*sWid
For srT=sSrc To sEnd Step sWid:Memory copy srT,srT+1,sDec
Next ' srY
End Sub