src/video/ataricommon/SDL_ataric2p.S
author Patrice Mandin
Fri, 06 Nov 2009 21:17:16 +0000
branchSDL-1.2
changeset 4375 a52047c790a2
parent 4159 a1b03ba2fcd0
child 5657 529d23724144
permissions -rw-r--r--
Disable C2P routines for Coldfire CPUs
     1 /*
     2     SDL - Simple DirectMedia Layer
     3     Copyright (C) 1997-2009 Sam Lantinga
     4 
     5     This library is free software; you can redistribute it and/or
     6     modify it under the terms of the GNU Lesser General Public
     7     License as published by the Free Software Foundation; either
     8     version 2.1 of the License, or (at your option) any later version.
     9 
    10     This library is distributed in the hope that it will be useful,
    11     but WITHOUT ANY WARRANTY; without even the implied warranty of
    12     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
    13     Lesser General Public License for more details.
    14 
    15     You should have received a copy of the GNU Lesser General Public
    16     License along with this library; if not, write to the Free Software
    17     Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
    18 
    19     Sam Lantinga
    20     slouken@libsdl.org
    21 */
    22 
    23 /*
    24 	Chunky to planar conversion routine
    25 	1 byte/pixel -> 4 or 8 bit planes
    26 
    27 	Patrice Mandin
    28 	Xavier Joubert
    29 	Mikael Kalms
    30 */
    31 
    32 	.globl	_SDL_Atari_C2pConvert
    33 	.globl	_SDL_Atari_C2pConvert8
    34 	.globl	_SDL_Atari_C2pConvert4
    35 	.globl	_SDL_Atari_C2pConvert4_pal
    36 
    37 /* ------------	Conversion C2P, 8 bits ------------ */
    38 
    39 	.text
    40 _SDL_Atari_C2pConvert8:
    41 #if !defined(__mcoldfire__)
    42 	movel	sp@(4),c2p_source
    43 	movel	sp@(8),c2p_dest
    44 	movel	sp@(12),c2p_width
    45 	movel	sp@(16),c2p_height
    46 	movel	sp@(20),c2p_dblligne
    47 	movel	sp@(24),c2p_srcpitch
    48 	movel	sp@(28),c2p_dstpitch
    49 
    50 	moveml	d2-d7/a2-a6,sp@-
    51 
    52 	movel	c2p_source,c2p_cursrc
    53 	movel	c2p_dest,c2p_curdst
    54 	movel	#0x0f0f0f0f,d4
    55 	movel	#0x00ff00ff,d5
    56 	movel	#0x55555555,d6
    57 	movew	c2p_height+2,c2p_row
    58 	movew	c2p_width+2,d0
    59 	andw	#-8,d0
    60 	movew	d0,c2p_rowlen
    61 
    62 SDL_Atari_C2p8_rowloop:
    63 
    64 	movel	c2p_cursrc,a0
    65 	movel	c2p_curdst,a1
    66 
    67 	movel	a0,a2
    68 	addw	c2p_rowlen,a2
    69 
    70 	movel	a0@+,d0
    71 	movel	a0@+,d1
    72 	movel	a0@+,d2
    73 	movel	a0@+,d3
    74 /*
    75 	d0 = a7a6a5a4a3a2a1a0 b7b6b5b4b3b2b1b0 c7c6c5c4c3c2c1c0 d7d6d5d4d3d2d1d0
    76 	d1 = e7e6e5e4e3e2e1e0 f7f6f5f4f3f2f1f0 g7g6g5g4g3g2g1g0 h7h6h5h4h3h2h1h0
    77 	d2 = i7i6i5i4i3i2i1i0 j7j6j5j4j3j2j1j0 k7k6k5k4k3k2k1k0 l7l6l5l4l3l2l1l0
    78 	d3 = m7m6m5m4m3m2m1m0 n7n6n5n4n3n2n1n0 o7o6o5o4o3o2o1o0 p7p6p5p4p3p2p1p0
    79 */
    80 	movel	d1,d7
    81 	lsrl	#4,d7
    82 	eorl	d0,d7
    83 	andl	d4,d7
    84 	eorl	d7,d0
    85 	lsll	#4,d7
    86 	eorl	d7,d1
    87 
    88 	movel	d3,d7
    89 	lsrl	#4,d7
    90 	eorl	d2,d7
    91 	andl	d4,d7
    92 	eorl	d7,d2
    93 	lsll	#4,d7
    94 	eorl	d7,d3
    95 
    96 	movel	d2,d7
    97 	lsrl	#8,d7
    98 	eorl	d0,d7
    99  	andl	d5,d7
   100 	eorl	d7,d0
   101 	lsll	#8,d7
   102 	eorl	d7,d2
   103 
   104 	movel	d3,d7
   105 	lsrl	#8,d7
   106 	eorl	d1,d7
   107  	andl	d5,d7
   108 	eorl	d7,d1
   109 	lsll	#8,d7
   110 	eorl	d7,d3
   111 /*
   112 	d0 = a7a6a5a4e7e6e5e4 i7i6i5i4m7m6m5m4 c7c6c5c4g7g6g5g4 k7k6k5k4o7o6o5o4
   113 	d1 = a3a2a1a0e3e2e1e0 i3i2i1i0m3m2m1m0 c3c2c1c0g3g2g1g0 k3k2k1k0o3o2o1o0
   114 	d2 = b7b6b5b4f7f6f5f4 j7j6j5j4n7n6n5n4 d7d6d5d4h7h6h5h4 l7l6l5l4p7p6p5p4
   115 	d3 = b3b2b1b0f3f2f1f0 j3j2j1j0n3n2n1n0 d3d2d1d0h3h2h1h0 l3l2l1l0p3p2p1p0
   116 */
   117 	bras	SDL_Atari_C2p8_start
   118 
   119 SDL_Atari_C2p8_pix16:
   120 
   121 	movel	a0@+,d0
   122 	movel	a0@+,d1
   123 	movel	a0@+,d2
   124 	movel	a0@+,d3
   125 /*
   126 	d0 = a7a6a5a4a3a2a1a0 b7b6b5b4b3b2b1b0 c7c6c5c4c3c2c1c0 d7d6d5d4d3d2d1d0
   127 	d1 = e7e6e5e4e3e2e1e0 f7f6f5f4f3f2f1f0 g7g6g5g4g3g2g1g0 h7h6h5h4h3h2h1h0
   128 	d2 = i7i6i5i4i3i2i1i0 j7j6j5j4j3j2j1j0 k7k6k5k4k3k2k1k0 l7l6l5l4l3l2l1l0
   129 	d3 = m7m6m5m4m3m2m1m0 n7n6n5n4n3n2n1n0 o7o6o5o4o3o2o1o0 p7p6p5p4p3p2p1p0
   130 */
   131 	movel	d1,d7
   132 	lsrl	#4,d7
   133 	movel	a3,a1@+
   134 	eorl	d0,d7
   135 	andl	d4,d7
   136 	eorl	d7,d0
   137 	lsll	#4,d7
   138 	eorl	d7,d1
   139 
   140 	movel	d3,d7
   141 	lsrl	#4,d7
   142 	eorl	d2,d7
   143 	andl	d4,d7
   144 	eorl	d7,d2
   145 	movel	a4,a1@+
   146 	lsll	#4,d7
   147 	eorl	d7,d3
   148 
   149 	movel	d2,d7
   150 	lsrl	#8,d7
   151 	eorl	d0,d7
   152 	andl	d5,d7
   153 	eorl	d7,d0
   154 	movel	a5,a1@+
   155 	lsll	#8,d7
   156 	eorl	d7,d2
   157 
   158 	movel	d3,d7
   159 	lsrl	#8,d7
   160 	eorl	d1,d7
   161 	andl	d5,d7
   162 	eorl	d7,d1
   163 	movel	a6,a1@+
   164 	lsll	#8,d7
   165 	eorl	d7,d3
   166 /*
   167 	d0 = a7a6a5a4e7e6e5e4 i7i6i5i4m7m6m5m4 c7c6c5c4g7g6g5g4 k7k6k5k4o7o6o5o4
   168 	d1 = a3a2a1a0e3e2e1e0 i3i2i1i0m3m2m1m0 c3c2c1c0g3g2g1g0 k3k2k1k0o3o2o1o0
   169 	d2 = b7b6b5b4f7f6f5f4 j7j6j5j4n7n6n5n4 d7d6d5d4h7h6h5h4 l7l6l5l4p7p6p5p4
   170 	d3 = b3b2b1b0f3f2f1f0 j3j2j1j0n3n2n1n0 d3d2d1d0h3h2h1h0 l3l2l1l0p3p2p1p0
   171 */
   172 
   173 SDL_Atari_C2p8_start:
   174 
   175 	movel	d2,d7
   176 	lsrl	#1,d7
   177 	eorl	d0,d7
   178 	andl	d6,d7
   179 	eorl	d7,d0
   180 	addl	d7,d7
   181 	eorl	d7,d2
   182 
   183 	movel	d3,d7
   184 	lsrl	#1,d7
   185 	eorl	d1,d7
   186 	andl	d6,d7
   187 	eorl	d7,d1
   188 	addl	d7,d7
   189 	eorl	d7,d3
   190 /*
   191 	d0 = a7b7a5b5e7f7e5f5 i7j7i5j5m7n7m5n5 c7d7c5d5g7h7g5h5 k7l7k5l5o7p7o5p5
   192 	d1 = a3b3a1b1e3f3e1f1 i3j3i1j1m3n3m1n1 c3d3c1d1g3h3g1h1 k3l3k1l1o3p3o1p1
   193 	d2 = a6b6a4b4e6f6e4f4 i6j6i4j4m6n6m4n4 c6d6c4d4g6h6g4h4 k6l6k4l4o6p6o4p4
   194 	d3 = a2b2a0b0e2f2e0f0 i2j2i0j0m2n2m0n0 c2d2c0d0g2h2g0h0 k2l2k0l0o2p2o0p0
   195 */
   196 	movew	d2,d7
   197 	movew	d0,d2
   198 	swap	d2
   199 	movew	d2,d0
   200 	movew	d7,d2
   201 
   202 	movew	d3,d7
   203 	movew	d1,d3
   204 	swap	d3
   205 	movew	d3,d1
   206 	movew	d7,d3
   207 /*
   208 	d0 = a7b7a5b5e7f7e5f5 i7j7i5j5m7n7m5n5 a6b6a4b4e6f6e4f4 i6j6i4j4m6n6m4n4
   209 	d1 = a3b3a1b1e3f3e1f1 i3j3i1j1m3n3m1n1 a2b2a0b0e2f2e0f0 i2j2i0j0m2n2m0n0
   210 	d2 = c7d7c5d5g7h7g5h5 k7l7k5l5o7p7o5p5 c6d6c4d4g6h6g4h4 k6l6k4l4o6p6o4p4
   211 	d3 = c3d3c1d1g3h3g1h1 k3l3k1l1o3p3o1p1 c2d2c0d0g2h2g0h0 k2l2k0l0o2p2o0p0
   212 */
   213 	movel	d2,d7
   214 	lsrl	#2,d7
   215 	eorl	d0,d7
   216 	andl	#0x33333333,d7
   217 	eorl	d7,d0
   218 	lsll	#2,d7
   219 	eorl	d7,d2
   220 
   221 	movel	d3,d7
   222 	lsrl	#2,d7
   223 	eorl	d1,d7
   224 	andl	#0x33333333,d7
   225 	eorl	d7,d1
   226 	lsll	#2,d7
   227 	eorl	d7,d3
   228 /*
   229 	d0 = a7b7c7d7e7f7g7h7 i7j7k7l7m7n7o7p7 a6b6c6d6e6f6g6h6 i6j6k6l6m6n6o6p6
   230 	d1 = a3b3c3d3e3f3g3h3 i3j3k3l3m3n3o3p3 a2b2c2d2e2f2g2h2 i2j2k2l2m2n2o2p2
   231 	d2 = a5b5c5d5e5f5g5h5 i5j5k5l5m5n5o5p5 a4b4c4d4e4f4g4h4 i4j4k4l4m4n4o4p4
   232 	d3 = a1b1c1d1e1f1g1h1 i1j1k1l1m1n1o1p1 a0b0c0d0e0f0g0h0 i0j0k0l0m0n0o0p0
   233 */
   234 	swap	d0
   235 	swap	d1
   236 	swap	d2
   237 	swap	d3
   238 
   239 	movel	d0,a6
   240 	movel	d2,a5
   241 	movel	d1,a4
   242 	movel	d3,a3
   243 
   244 	cmpl	a0,a2
   245 	bgt		SDL_Atari_C2p8_pix16
   246 
   247 	movel	a3,a1@+
   248 	movel	a4,a1@+
   249 	movel	a5,a1@+
   250 	movel	a6,a1@+
   251 
   252 	/* Double the line ? */
   253 
   254 	movel	c2p_srcpitch,d0
   255 	movel	c2p_dstpitch,d1
   256 
   257 	tstl	c2p_dblligne
   258 	beqs	SDL_Atari_C2p8_nodblline
   259 
   260 	movel	c2p_curdst,a0
   261 	movel	a0,a1
   262 	addl	d1,a1
   263 
   264 	movew	c2p_width+2,d7
   265 	lsrw	#4,d7
   266 	subql	#1,d7
   267 SDL_Atari_C2p8_dblloop:
   268 	movel	a0@+,a1@+
   269 	movel	a0@+,a1@+
   270 	movel	a0@+,a1@+
   271 	movel	a0@+,a1@+
   272 	dbra	d7,SDL_Atari_C2p8_dblloop
   273 
   274 	addl	d1,c2p_curdst
   275 
   276 SDL_Atari_C2p8_nodblline:
   277 
   278 	/* Next line */
   279 
   280 	addl	d0,c2p_cursrc
   281 	addl	d1,c2p_curdst
   282 
   283 	subqw	#1,c2p_row
   284 	bne		SDL_Atari_C2p8_rowloop	
   285 
   286 	moveml	sp@+,d2-d7/a2-a6
   287 #endif
   288 	rts
   289 
   290 /* ------------	Conversion C2P, 4 bits ------------ */
   291 
   292 _SDL_Atari_C2pConvert4:
   293 #if !defined(__mcoldfire__)
   294 	movel	sp@(4),c2p_source
   295 	movel	sp@(8),c2p_dest
   296 	movel	sp@(12),c2p_width
   297 	movel	sp@(16),c2p_height
   298 	movel	sp@(20),c2p_dblligne
   299 	movel	sp@(24),c2p_srcpitch
   300 	movel	sp@(28),c2p_dstpitch
   301 
   302 	moveml	d2-d7/a2-a6,sp@-
   303 
   304 	movel	c2p_source,a0
   305 	movel	c2p_dest,a1
   306 	lea	_SDL_Atari_table_c2p,a2
   307 	movel	#0x00070001,d3
   308 #if defined(__M68020__)
   309 	moveq	#0,d0
   310 #endif
   311 	
   312 	movel	c2p_height,d7
   313 	subql	#1,d7
   314 c2p4_bcly:
   315 	movel	a0,a4	| Save start address of source
   316 	movel	a1,a5	| Save start address of dest
   317 
   318 	| Conversion
   319                  			
   320 	movel	c2p_width,d6
   321 	lsrw	#4,d6
   322 	subql	#1,d6
   323 c2p4_bclx:
   324 	| Octets 0-7
   325 	
   326 	moveq	#0,d1
   327 	moveq	#7,d5
   328 c2p4_bcl07:
   329 #if defined(__M68020__)
   330 	moveb	a0@+,d0
   331 	lea		a2@(0,d0:w:4),a3
   332 #else
   333 	moveq	#0,d0
   334 	moveb	a0@+,d0
   335 	lslw	#2,d0
   336 	lea		a2@(0,d0:w),a3
   337 #endif
   338 	lsll	#1,d1
   339 	orl		a3@,d1
   340 	dbra	d5,c2p4_bcl07
   341 
   342 	movepl	d1,a1@(0)
   343 	addw	d3,a1
   344 	swap	d3
   345 	
   346 	| Octets 8-15
   347 
   348 	moveq	#0,d1
   349 	moveq	#7,d5
   350 c2p4_bcl815:
   351 #if defined(__M68020__)
   352 	moveb	a0@+,d0
   353 	lea		a2@(0,d0:w:4),a3
   354 #else
   355 	moveq	#0,d0
   356 	moveb	a0@+,d0
   357 	lslw	#2,d0
   358 	lea		a2@(0,d0:w),a3
   359 #endif
   360 	lsll	#1,d1
   361 	orl		a3@,d1
   362 	dbra	d5,c2p4_bcl815
   363 
   364 	movepl	d1,a1@(0)
   365 	addw	d3,a1
   366 	swap	d3
   367 
   368 	dbra	d6,c2p4_bclx
   369 
   370 	| Double line ?
   371 
   372 	tstl	c2p_dblligne
   373 	beqs	c2p4_nodblligne
   374 
   375 	movel	a5,a6			| src line
   376 	movel	a5,a1			| dest line
   377 	addl	c2p_dstpitch,a1
   378 
   379 	movel	c2p_width,d6
   380 	lsrw	#3,d6
   381 	subql	#1,d6
   382 c2p4_copydbl:
   383 	movel	a6@+,a1@+
   384 	dbra	d6,c2p4_copydbl
   385 
   386 	addl	c2p_dstpitch,a5
   387 c2p4_nodblligne:
   388 
   389 	| Next line
   390 
   391 	movel	a4,a0		
   392 	addl	c2p_srcpitch,a0
   393 	movel	a5,a1
   394 	addl	c2p_dstpitch,a1
   395 
   396 	dbra	d7,c2p4_bcly
   397 
   398 	moveml	sp@+,d2-d7/a2-a6
   399 #endif
   400 	rts
   401 
   402 /* ------------	Conversion of a light palette in 4 bits ------------ */
   403 
   404 _SDL_Atari_C2pConvert4_pal:
   405 #if !defined(__mcoldfire__)
   406 	/* a0 is a 256-word light palette */
   407 	movel	sp@(4),a0
   408 
   409 	moveml	d2-d3,sp@-
   410 
   411 	lea		_SDL_Atari_table_c2p,a1
   412 	movew	#255,d3
   413 c2p_pal_initbcl:
   414 	movew	a0@+,d0
   415 	lsrw	#4,d0
   416 	andw	#15,d0
   417 
   418 	moveq	#3,d1
   419 c2p_pal_initbyte:
   420 	btst	d1,d0
   421 	sne		d2
   422 	negw	d2
   423 	moveb	d2,a1@(0,d1:w)
   424 
   425 	dbra	d1,c2p_pal_initbyte
   426 
   427 	addql	#4,a1
   428 	dbra	d3,c2p_pal_initbcl
   429 
   430 	moveml	sp@+,d2-d3
   431 #endif
   432 	rts
   433 
   434 /* ------------	Buffers ------------ */
   435 
   436 	.bss
   437 
   438 	.even
   439 	.comm	_SDL_Atari_C2pConvert,4
   440 	.comm	_SDL_Atari_table_c2p,1024
   441 
   442 	.comm	c2p_source,4	/* Source framebuffer */
   443 	.comm	c2p_dest,4		/* Destination framebuffer */
   444 	.comm	c2p_width,4		/* Width of zone to convert */
   445 	.comm	c2p_height,4	/* Height of zone to convert */
   446 	.comm	c2p_dblligne,4	/* Double the lines while converting ? */
   447 	.comm	c2p_srcpitch,4	/* Source pitch */
   448 	.comm	c2p_dstpitch,4	/* Destination pitch */
   449 	.comm	c2p_cursrc,4	/* Current source line */
   450 	.comm	c2p_curdst,4	/* Current destination line */
   451 	.comm	c2p_rowlen,2	/* Line length in bytes */
   452 	.comm	c2p_row,2		/* Current line number */