| | 1362 | |
|---|
| | 1363 | #else |
|---|
| | 1364 | for ( i_x = i_width / 8; i_x--; ) |
|---|
| | 1365 | { |
|---|
| | 1366 | __asm__ ( |
|---|
| | 1367 | "movd (%1), %%mm0 # Load 4 Cb 00 00 00 00 u3 u2 u1 u0\n\t" |
|---|
| | 1368 | "movd (%2), %%mm1 # Load 4 Cr 00 00 00 00 v3 v2 v1 v0\n\t" |
|---|
| | 1369 | "pxor %%mm4, %%mm4 # zero mm4\n\t" |
|---|
| | 1370 | "movq (%0), %%mm6 # Load 8 Y Y7 Y6 Y5 Y4 Y3 Y2 Y1 Y0\n\t" |
|---|
| | 1371 | //"movl $0, (%3) # cache preload for image\n\t" |
|---|
| | 1372 | : : "r" (p_y), "r" (p_u), "r" (p_v), "r" (p_buffer)); |
|---|
| | 1373 | |
|---|
| | 1374 | __asm__ ( |
|---|
| | 1375 | ".align 8 \n\t" |
|---|
| | 1376 | /* Do the multiply part of the conversion for even and odd pixels, |
|---|
| | 1377 | * register usage: |
|---|
| | 1378 | * mm0 -> Cblue, mm1 -> Cred, mm2 -> Cgreen even pixels, |
|---|
| | 1379 | * mm3 -> Cblue, mm4 -> Cred, mm5 -> Cgreen odd pixels, |
|---|
| | 1380 | * mm6 -> Y even, mm7 -> Y odd */ |
|---|
| | 1381 | /* convert the chroma part */ |
|---|
| | 1382 | "punpcklbw %%mm4, %%mm0 # scatter 4 Cb 00 u3 00 u2 00 u1 00 u0\n\t" |
|---|
| | 1383 | "punpcklbw %%mm4, %%mm1 # scatter 4 Cr 00 v3 00 v2 00 v1 00 v0\n\t" |
|---|
| | 1384 | "psubsw mmx_80w, %%mm0 # Cb -= 128\n\t" |
|---|
| | 1385 | "psubsw mmx_80w, %%mm1 # Cr -= 128\n\t" |
|---|
| | 1386 | "psllw $3, %%mm0 # Promote precision\n\t" |
|---|
| | 1387 | "psllw $3, %%mm1 # Promote precision\n\t" |
|---|
| | 1388 | "movq %%mm0, %%mm2 # Copy 4 Cb 00 u3 00 u2 00 u1 00 u0\n\t" |
|---|
| | 1389 | "movq %%mm1, %%mm3 # Copy 4 Cr 00 v3 00 v2 00 v1 00 v0\n\t" |
|---|
| | 1390 | "pmulhw mmx_U_green, %%mm2# Mul Cb with green coeff -> Cb green\n\t" |
|---|
| | 1391 | "pmulhw mmx_V_green, %%mm3# Mul Cr with green coeff -> Cr green\n\t" |
|---|
| | 1392 | "pmulhw mmx_U_blue, %%mm0 # Mul Cb -> Cblue 00 b3 00 b2 00 b1 00 b0\n\t" |
|---|
| | 1393 | "pmulhw mmx_V_red, %%mm1 # Mul Cr -> Cred 00 r3 00 r2 00 r1 00 r0\n\t" |
|---|
| | 1394 | "paddsw %%mm3, %%mm2 # Cb green + Cr green -> Cgreen\n\t" |
|---|
| | 1395 | /* convert the luma part */ |
|---|
| | 1396 | "psubusb mmx_10w, %%mm6 # Y -= 16\n\t" |
|---|
| | 1397 | "movq %%mm6, %%mm7 # Copy 8 Y Y7 Y6 Y5 Y4 Y3 Y2 Y1 Y0\n\t" |
|---|
| | 1398 | "pand mmx_00ffw, %%mm6 # get Y even 00 Y6 00 Y4 00 Y2 00 Y0\n\t" |
|---|
| | 1399 | "psrlw $8, %%mm7 # get Y odd 00 Y7 00 Y5 00 Y3 00 Y1\n\t" |
|---|
| | 1400 | "psllw $3, %%mm6 # Promote precision\n\t" |
|---|
| | 1401 | "psllw $3, %%mm7 # Promote precision\n\t" |
|---|
| | 1402 | "pmulhw mmx_Y_coeff, %%mm6# Mul 4 Y even 00 y6 00 y4 00 y2 00 y0\n\t" |
|---|
| | 1403 | "pmulhw mmx_Y_coeff, %%mm7# Mul 4 Y odd 00 y7 00 y5 00 y3 00 y1\n\t" |
|---|
| | 1404 | /* Do the addition part of the conversion for even and odd pixels, |
|---|
| | 1405 | * register usage: |
|---|
| | 1406 | * mm0 -> Cblue, mm1 -> Cred, mm2 -> Cgreen even pixels, |
|---|
| | 1407 | * mm3 -> Cblue, mm4 -> Cred, mm5 -> Cgreen odd pixels, |
|---|
| | 1408 | * mm6 -> Y even, mm7 -> Y odd */ /* Do horizontal and vertical scaling */ |
|---|
| | 1409 | "movq %%mm0, %%mm3 # Copy Cblue\n\t" |
|---|
| | 1410 | "movq %%mm1, %%mm4 # Copy Cred\n\t" |
|---|
| | 1411 | "movq %%mm2, %%mm5 # Copy Cgreen\n\t" |
|---|
| | 1412 | "paddsw %%mm6, %%mm0 # Y even + Cblue 00 B6 00 B4 00 B2 00 B0\n\t" |
|---|
| | 1413 | "paddsw %%mm7, %%mm3 # Y odd + Cblue 00 B7 00 B5 00 B3 00 B1\n\t" |
|---|
| | 1414 | "paddsw %%mm6, %%mm1 # Y even + Cred 00 R6 00 R4 00 R2 00 R0\n\t" |
|---|
| | 1415 | "paddsw %%mm7, %%mm4 # Y odd + Cred 00 R7 00 R5 00 R3 00 R1\n\t" |
|---|
| | 1416 | "paddsw %%mm6, %%mm2 # Y even + Cgreen 00 G6 00 G4 00 G2 00 G0\n\t" |
|---|
| | 1417 | "paddsw %%mm7, %%mm5 # Y odd + Cgreen 00 G7 00 G5 00 G3 00 G1\n\t" |
|---|
| | 1418 | /* Limit RGB even to 0..255 */ |
|---|
| | 1419 | "packuswb %%mm0, %%mm0 # B6 B4 B2 B0 | B6 B4 B2 B0\n\t" |
|---|
| | 1420 | "packuswb %%mm1, %%mm1 # R6 R4 R2 R0 | R6 R4 R2 R0\n\t" |
|---|
| | 1421 | "packuswb %%mm2, %%mm2 # G6 G4 G2 G0 | G6 G4 G2 G0\n\t" |
|---|
| | 1422 | /* Limit RGB odd to 0..255 */ |
|---|
| | 1423 | "packuswb %%mm3, %%mm3 # B7 B5 B3 B1 | B7 B5 B3 B1\n\t" |
|---|
| | 1424 | "packuswb %%mm4, %%mm4 # R7 R5 R3 R1 | R7 R5 R3 R1\n\t" |
|---|
| | 1425 | "packuswb %%mm5, %%mm5 # G7 G5 G3 G1 | G7 G5 G3 G1\n\t" |
|---|
| | 1426 | /* Interleave RGB even and odd */ |
|---|
| | 1427 | "punpcklbw %%mm3, %%mm0 # B7 B6 B5 B4 B3 B2 B1 B0\n\t" |
|---|
| | 1428 | "punpcklbw %%mm4, %%mm1 # R7 R6 R5 R4 R3 R2 R1 R0\n\t" |
|---|
| | 1429 | "punpcklbw %%mm5, %%mm2 # G7 G6 G5 G4 G3 G2 G1 G0\n\t" |
|---|
| | 1430 | /* mask unneeded bits off */ |
|---|
| | 1431 | "pand mmx_redmask, %%mm0# b7b6b5b4 b3_0_0_0 b7b6b5b4 b3_0_0_0\n\t" |
|---|
| | 1432 | "pand mmx_grnmask, %%mm2# g7g6g5g4 g3g2_0_0 g7g6g5g4 g3g2_0_0\n\t" |
|---|
| | 1433 | "pand mmx_redmask, %%mm1# r7r6r5r4 r3_0_0_0 r7r6r5r4 r3_0_0_0\n\t" |
|---|
| | 1434 | "psrlw mmx_blueshift,%%mm0#0_0_0_b7 b6b5b4b3 0_0_0_b7 b6b5b4b3\n\t" |
|---|
| | 1435 | "pxor %%mm4, %%mm4 # zero mm4\n\t" |
|---|
| | 1436 | "movq %%mm0, %%mm5 # Copy B7-B0\n\t" |
|---|
| | 1437 | "movq %%mm2, %%mm7 # Copy G7-G0\n\t" |
|---|
| | 1438 | /* convert rgb24 plane to rgb16 pack for pixel 0-3 */ |
|---|
| | 1439 | "punpcklbw %%mm4, %%mm2 # 0_0_0_0 0_0_0_0 g7g6g5g4 g3g2_0_0\n\t" |
|---|
| | 1440 | "punpcklbw %%mm1, %%mm0 # r7r6r5r4 r3_0_0_0 0_0_0_b7 b6b5b4b3\n\t" |
|---|
| | 1441 | "psllw mmx_blueshift,%%mm2# 0_0_0_0 0_g7g6g5 g4g3g2_0 0_0_0_0\n\t" |
|---|
| | 1442 | "por %%mm2, %%mm0 # r7r6r5r4 r3g7g6g5 g4g3g2b7 b6b5b4b3\n\t" |
|---|
| | 1443 | "movq 8(%0), %%mm6 # Load 8 Y Y7 Y6 Y5 Y4 Y3 Y2 Y1 Y0\n\t" |
|---|
| | 1444 | "movq %%mm0, (%3) # store pixel 0-3\n\t" |
|---|
| | 1445 | /* convert rgb24 plane to rgb16 pack for pixel 0-3 */ |
|---|
| | 1446 | "punpckhbw %%mm4, %%mm7 # 0_0_0_0 0_0_0_0 g7g6g5g4 g3g2_0_0\n\t" |
|---|
| | 1447 | "punpckhbw %%mm1, %%mm5 # r7r6r5r4 r3_0_0_0 0_0_0_b7 b6b5b4b3\n\t" |
|---|
| | 1448 | "psllw mmx_blueshift,%%mm7# 0_0_0_0 0_g7g6g5 g4g3g2_0 0_0_0_0\n\t" |
|---|
| | 1449 | "movd 4(%1), %%mm0 # Load 4 Cb 00 00 00 00 u3 u2 u1 u0\n\t" |
|---|
| | 1450 | "por %%mm7, %%mm5 # r7r6r5r4 r3g7g6g5 g4g3g2b7 b6b5b4b3\n\t" |
|---|
| | 1451 | "movd 4(%2), %%mm1 # Load 4 Cr 00 00 00 00 v3 v2 v1 v0\n\t" |
|---|
| | 1452 | "movq %%mm5, 8(%3) # store pixel 4-7\n\t" |
|---|
| | 1453 | : : "r" (p_y), "r" (p_u), "r" (p_v), "r" (p_buffer)); |
|---|
| | 1454 | p_y += 8; |
|---|
| | 1455 | p_u += 4; |
|---|
| | 1456 | p_v += 4; |
|---|
| | 1457 | p_buffer += 8; |
|---|
| | 1458 | } |
|---|
| | 1459 | |
|---|
| | 1460 | SCALE_WIDTH; |
|---|
| | 1461 | SCALE_HEIGHT(420, 2); |
|---|
| | 1462 | } |
|---|
| | 1463 | __asm__ ("emms\n\t"); |
|---|
| | 1464 | #endif |
|---|