src/video/SDL_fillrect.c
author Gabriel Jacobo <gabomdq@gmail.com>
Wed, 21 Aug 2013 10:12:16 -0300
changeset 7679 b1fe132bc6a4
parent 7678 286c42d7c5ed
child 7680 6ab959ebea26
permissions -rw-r--r--
Fixes for -Wdeclaration-after-statement
slouken@2888
     1
/*
slouken@5535
     2
  Simple DirectMedia Layer
slouken@6885
     3
  Copyright (C) 1997-2013 Sam Lantinga <slouken@libsdl.org>
slouken@2888
     4
slouken@5535
     5
  This software is provided 'as-is', without any express or implied
slouken@5535
     6
  warranty.  In no event will the authors be held liable for any damages
slouken@5535
     7
  arising from the use of this software.
slouken@2888
     8
slouken@5535
     9
  Permission is granted to anyone to use this software for any purpose,
slouken@5535
    10
  including commercial applications, and to alter it and redistribute it
slouken@5535
    11
  freely, subject to the following restrictions:
slouken@2888
    12
slouken@5535
    13
  1. The origin of this software must not be misrepresented; you must not
slouken@5535
    14
     claim that you wrote the original software. If you use this software
slouken@5535
    15
     in a product, an acknowledgment in the product documentation would be
slouken@5535
    16
     appreciated but is not required.
slouken@5535
    17
  2. Altered source versions must be plainly marked as such, and must not be
slouken@5535
    18
     misrepresented as being the original software.
slouken@5535
    19
  3. This notice may not be removed or altered from any source distribution.
slouken@2888
    20
*/
slouken@2888
    21
#include "SDL_config.h"
slouken@2888
    22
slouken@2888
    23
#include "SDL_video.h"
slouken@2888
    24
#include "SDL_blit.h"
slouken@2888
    25
slouken@2888
    26
slouken@2888
    27
#ifdef __SSE__
slouken@2888
    28
/* *INDENT-OFF* */
slouken@2888
    29
slouken@2888
    30
#ifdef _MSC_VER
slouken@2888
    31
#define SSE_BEGIN \
slouken@2888
    32
    __m128 c128; \
slouken@2888
    33
    c128.m128_u32[0] = color; \
slouken@2888
    34
    c128.m128_u32[1] = color; \
slouken@2888
    35
    c128.m128_u32[2] = color; \
slouken@2888
    36
    c128.m128_u32[3] = color;
slouken@2888
    37
#else
slouken@2888
    38
#define SSE_BEGIN \
gabomdq@7679
    39
    __m128 c128; \
slouken@2888
    40
    DECLARE_ALIGNED(Uint32, cccc[4], 16); \
slouken@2888
    41
    cccc[0] = color; \
slouken@2888
    42
    cccc[1] = color; \
slouken@2888
    43
    cccc[2] = color; \
slouken@2888
    44
    cccc[3] = color; \
gabomdq@7679
    45
    c128 = *(__m128 *)cccc;
slouken@2888
    46
#endif
slouken@2888
    47
slouken@2888
    48
#define SSE_WORK \
slouken@2888
    49
    for (i = n / 64; i--;) { \
slouken@2888
    50
        _mm_stream_ps((float *)(p+0), c128); \
slouken@2888
    51
        _mm_stream_ps((float *)(p+16), c128); \
slouken@2888
    52
        _mm_stream_ps((float *)(p+32), c128); \
slouken@2888
    53
        _mm_stream_ps((float *)(p+48), c128); \
slouken@2888
    54
        p += 64; \
slouken@2888
    55
    }
slouken@2888
    56
slouken@2888
    57
#define SSE_END
slouken@2888
    58
slouken@2888
    59
#define DEFINE_SSE_FILLRECT(bpp, type) \
slouken@2888
    60
static void \
slouken@2888
    61
SDL_FillRect##bpp##SSE(Uint8 *pixels, int pitch, Uint32 color, int w, int h) \
slouken@2888
    62
{ \
gabomdq@7679
    63
    int i, n; \
gabomdq@7679
    64
    Uint8 *p = NULL; \
gabomdq@7679
    65
 \
slouken@2888
    66
    SSE_BEGIN; \
slouken@2888
    67
 \
slouken@2888
    68
    while (h--) { \
gabomdq@7679
    69
        n = w * bpp; \
gabomdq@7679
    70
        p = pixels; \
slouken@2888
    71
 \
slouken@3012
    72
        if (n > 63) { \
slouken@2888
    73
            int adjust = 16 - ((uintptr_t)p & 15); \
slouken@2888
    74
            if (adjust < 16) { \
slouken@2888
    75
                n -= adjust; \
slouken@2888
    76
                adjust /= bpp; \
slouken@2888
    77
                while (adjust--) { \
slouken@2888
    78
                    *((type *)p) = (type)color; \
slouken@2888
    79
                    p += bpp; \
slouken@2888
    80
                } \
slouken@2888
    81
            } \
slouken@2888
    82
            SSE_WORK; \
slouken@2888
    83
        } \
slouken@2888
    84
        if (n & 63) { \
slouken@2888
    85
            int remainder = (n & 63); \
slouken@2888
    86
            remainder /= bpp; \
slouken@2888
    87
            while (remainder--) { \
slouken@2888
    88
                *((type *)p) = (type)color; \
slouken@2888
    89
                p += bpp; \
slouken@2888
    90
            } \
slouken@2888
    91
        } \
slouken@2888
    92
        pixels += pitch; \
slouken@2888
    93
    } \
slouken@2888
    94
 \
slouken@2888
    95
    SSE_END; \
slouken@2888
    96
}
slouken@2888
    97
slouken@3012
    98
static void
slouken@3012
    99
SDL_FillRect1SSE(Uint8 *pixels, int pitch, Uint32 color, int w, int h)
slouken@3012
   100
{
gabomdq@7679
   101
    int i, n;
gabomdq@7679
   102
    Uint8 *p = NULL;
gabomdq@7679
   103
    
slouken@3012
   104
    SSE_BEGIN;
slouken@3012
   105
    while (h--) {
gabomdq@7679
   106
        n = w;
gabomdq@7679
   107
        p = pixels;
slouken@3012
   108
slouken@3012
   109
        if (n > 63) {
slouken@3012
   110
            int adjust = 16 - ((uintptr_t)p & 15);
slouken@3012
   111
            if (adjust) {
slouken@3012
   112
                n -= adjust;
slouken@3012
   113
                SDL_memset(p, color, adjust);
slouken@3012
   114
                p += adjust;
slouken@3012
   115
            }
slouken@3012
   116
            SSE_WORK;
slouken@3012
   117
        }
slouken@3012
   118
        if (n & 63) {
slouken@3012
   119
            int remainder = (n & 63);
slouken@3012
   120
            SDL_memset(p, color, remainder);
slouken@3012
   121
            p += remainder;
slouken@3012
   122
        }
slouken@3012
   123
        pixels += pitch;
slouken@3012
   124
    }
slouken@3012
   125
slouken@3012
   126
    SSE_END;
slouken@3012
   127
}
gabomdq@7678
   128
/* DEFINE_SSE_FILLRECT(1, Uint8) */
slouken@2888
   129
DEFINE_SSE_FILLRECT(2, Uint16)
slouken@2888
   130
DEFINE_SSE_FILLRECT(4, Uint32)
slouken@2888
   131
slouken@2888
   132
/* *INDENT-ON* */
slouken@2888
   133
#endif /* __SSE__ */
slouken@2888
   134
slouken@2888
   135
#ifdef __MMX__
slouken@2888
   136
/* *INDENT-OFF* */
slouken@2888
   137
slouken@2888
   138
#define MMX_BEGIN \
slouken@2888
   139
    __m64 c64 = _mm_set_pi32(color, color)
slouken@2888
   140
slouken@2888
   141
#define MMX_WORK \
slouken@2888
   142
    for (i = n / 64; i--;) { \
slouken@2888
   143
        _mm_stream_pi((__m64 *)(p+0), c64); \
slouken@2888
   144
        _mm_stream_pi((__m64 *)(p+8), c64); \
slouken@2888
   145
        _mm_stream_pi((__m64 *)(p+16), c64); \
slouken@2888
   146
        _mm_stream_pi((__m64 *)(p+24), c64); \
slouken@2888
   147
        _mm_stream_pi((__m64 *)(p+32), c64); \
slouken@2888
   148
        _mm_stream_pi((__m64 *)(p+40), c64); \
slouken@2888
   149
        _mm_stream_pi((__m64 *)(p+48), c64); \
slouken@2888
   150
        _mm_stream_pi((__m64 *)(p+56), c64); \
slouken@2888
   151
        p += 64; \
slouken@2888
   152
    }
slouken@2888
   153
slouken@2888
   154
#define MMX_END \
slouken@2888
   155
    _mm_empty()
slouken@2888
   156
slouken@2888
   157
#define DEFINE_MMX_FILLRECT(bpp, type) \
slouken@2888
   158
static void \
slouken@2888
   159
SDL_FillRect##bpp##MMX(Uint8 *pixels, int pitch, Uint32 color, int w, int h) \
slouken@2888
   160
{ \
gabomdq@7679
   161
    int i, n; \
gabomdq@7679
   162
    Uint8 *p = NULL; \
gabomdq@7679
   163
 \
slouken@2888
   164
    MMX_BEGIN; \
slouken@2888
   165
 \
slouken@2888
   166
    while (h--) { \
gabomdq@7679
   167
        n = w * bpp; \
gabomdq@7679
   168
        p = pixels; \
slouken@2888
   169
 \
slouken@3012
   170
        if (n > 63) { \
slouken@2888
   171
            int adjust = 8 - ((uintptr_t)p & 7); \
slouken@2888
   172
            if (adjust < 8) { \
slouken@2888
   173
                n -= adjust; \
slouken@2888
   174
                adjust /= bpp; \
slouken@2888
   175
                while (adjust--) { \
slouken@2888
   176
                    *((type *)p) = (type)color; \
slouken@2888
   177
                    p += bpp; \
slouken@2888
   178
                } \
slouken@2888
   179
            } \
slouken@2888
   180
            MMX_WORK; \
slouken@2888
   181
        } \
slouken@2888
   182
        if (n & 63) { \
slouken@2888
   183
            int remainder = (n & 63); \
slouken@2888
   184
            remainder /= bpp; \
slouken@2888
   185
            while (remainder--) { \
slouken@2888
   186
                *((type *)p) = (type)color; \
slouken@2888
   187
                p += bpp; \
slouken@2888
   188
            } \
slouken@2888
   189
        } \
slouken@2888
   190
        pixels += pitch; \
slouken@2888
   191
    } \
slouken@2888
   192
 \
slouken@2888
   193
    MMX_END; \
slouken@2888
   194
}
slouken@2888
   195
slouken@3012
   196
static void
slouken@3012
   197
SDL_FillRect1MMX(Uint8 *pixels, int pitch, Uint32 color, int w, int h)
slouken@3012
   198
{
slouken@3012
   199
    MMX_BEGIN;
slouken@3012
   200
slouken@3012
   201
    while (h--) {
slouken@3012
   202
        int i, n = w;
slouken@3012
   203
        Uint8 *p = pixels;
slouken@3012
   204
slouken@3012
   205
        if (n > 63) {
slouken@3012
   206
            int adjust = 8 - ((uintptr_t)p & 7);
slouken@3012
   207
            if (adjust) {
slouken@3012
   208
                n -= adjust;
slouken@3012
   209
                SDL_memset(p, color, adjust);
slouken@3012
   210
                p += adjust;
slouken@3012
   211
            }
slouken@3012
   212
            MMX_WORK;
slouken@3012
   213
        }
slouken@3012
   214
        if (n & 63) {
slouken@3012
   215
            int remainder = (n & 63);
slouken@3012
   216
            SDL_memset(p, color, remainder);
slouken@3012
   217
            p += remainder;
slouken@3012
   218
        }
slouken@3012
   219
        pixels += pitch;
slouken@3012
   220
    }
slouken@3012
   221
slouken@3012
   222
    MMX_END;
slouken@3012
   223
}
gabomdq@7678
   224
/* DEFINE_MMX_FILLRECT(1, Uint8) */
slouken@2888
   225
DEFINE_MMX_FILLRECT(2, Uint16)
slouken@2888
   226
DEFINE_MMX_FILLRECT(4, Uint32)
slouken@2888
   227
slouken@2888
   228
/* *INDENT-ON* */
slouken@2888
   229
#endif /* __MMX__ */
slouken@2888
   230
slouken@2888
   231
static void
slouken@2888
   232
SDL_FillRect1(Uint8 * pixels, int pitch, Uint32 color, int w, int h)
slouken@2888
   233
{
slouken@2888
   234
    while (h--) {
slouken@2888
   235
        int n = w;
slouken@2888
   236
        Uint8 *p = pixels;
slouken@2888
   237
slouken@2888
   238
        if (n > 3) {
slouken@2888
   239
            switch ((uintptr_t) p & 3) {
slouken@2888
   240
            case 1:
slouken@2888
   241
                *p++ = (Uint8) color;
slouken@2888
   242
                --n;
slouken@2888
   243
            case 2:
slouken@2888
   244
                *p++ = (Uint8) color;
slouken@2888
   245
                --n;
slouken@2888
   246
            case 3:
slouken@2888
   247
                *p++ = (Uint8) color;
slouken@2888
   248
                --n;
slouken@2888
   249
            }
slouken@2888
   250
            SDL_memset4(p, color, (n >> 2));
slouken@2888
   251
        }
slouken@2888
   252
        if (n & 3) {
slouken@2888
   253
            p += (n & ~3);
slouken@2888
   254
            switch (n & 3) {
slouken@2888
   255
            case 3:
slouken@2888
   256
                *p++ = (Uint8) color;
slouken@2888
   257
            case 2:
slouken@2888
   258
                *p++ = (Uint8) color;
slouken@2888
   259
            case 1:
slouken@2888
   260
                *p++ = (Uint8) color;
slouken@2888
   261
            }
slouken@2888
   262
        }
slouken@2888
   263
        pixels += pitch;
slouken@2888
   264
    }
slouken@2888
   265
}
slouken@2888
   266
slouken@2888
   267
static void
slouken@2888
   268
SDL_FillRect2(Uint8 * pixels, int pitch, Uint32 color, int w, int h)
slouken@2888
   269
{
slouken@2888
   270
    while (h--) {
slouken@2888
   271
        int n = w;
slouken@2888
   272
        Uint16 *p = (Uint16 *) pixels;
slouken@2888
   273
slouken@2888
   274
        if (n > 1) {
slouken@2888
   275
            if ((uintptr_t) p & 2) {
slouken@2888
   276
                *p++ = (Uint16) color;
slouken@2888
   277
                --n;
slouken@2888
   278
            }
slouken@2888
   279
            SDL_memset4(p, color, (n >> 1));
slouken@2888
   280
        }
slouken@2888
   281
        if (n & 1) {
slouken@2888
   282
            p[n - 1] = (Uint16) color;
slouken@2888
   283
        }
slouken@2888
   284
        pixels += pitch;
slouken@2888
   285
    }
slouken@2888
   286
}
slouken@2888
   287
slouken@2888
   288
static void
slouken@2888
   289
SDL_FillRect3(Uint8 * pixels, int pitch, Uint32 color, int w, int h)
slouken@2888
   290
{
slouken@2888
   291
    Uint8 r = (Uint8) ((color >> 16) & 0xFF);
slouken@2888
   292
    Uint8 g = (Uint8) ((color >> 8) & 0xFF);
slouken@2888
   293
    Uint8 b = (Uint8) (color & 0xFF);
slouken@2888
   294
slouken@2888
   295
    while (h--) {
slouken@2888
   296
        int n = w;
slouken@2888
   297
        Uint8 *p = pixels;
slouken@2888
   298
slouken@2888
   299
        while (n--) {
slouken@2888
   300
            *p++ = r;
slouken@2888
   301
            *p++ = g;
slouken@2888
   302
            *p++ = b;
slouken@2888
   303
        }
slouken@2888
   304
        pixels += pitch;
slouken@2888
   305
    }
slouken@2888
   306
}
slouken@2888
   307
slouken@2888
   308
static void
slouken@2888
   309
SDL_FillRect4(Uint8 * pixels, int pitch, Uint32 color, int w, int h)
slouken@2888
   310
{
slouken@2888
   311
    while (h--) {
slouken@2888
   312
        SDL_memset4(pixels, color, w);
slouken@2888
   313
        pixels += pitch;
slouken@2888
   314
    }
slouken@2888
   315
}
slouken@2888
   316
slouken@2888
   317
/* 
slouken@2888
   318
 * This function performs a fast fill of the given rectangle with 'color'
slouken@2888
   319
 */
slouken@2888
   320
int
slouken@3536
   321
SDL_FillRect(SDL_Surface * dst, const SDL_Rect * rect, Uint32 color)
slouken@2888
   322
{
slouken@3536
   323
    SDL_Rect clipped;
slouken@2888
   324
    Uint8 *pixels;
slouken@2888
   325
slouken@3536
   326
    if (!dst) {
icculus@7037
   327
        return SDL_SetError("Passed NULL destination surface");
slouken@3536
   328
    }
slouken@3536
   329
slouken@2888
   330
    /* This function doesn't work on surfaces < 8 bpp */
slouken@2888
   331
    if (dst->format->BitsPerPixel < 8) {
icculus@7037
   332
        return SDL_SetError("SDL_FillRect(): Unsupported surface format");
slouken@2888
   333
    }
slouken@2888
   334
slouken@3536
   335
    /* If 'rect' == NULL, then fill the whole surface */
slouken@3536
   336
    if (rect) {
slouken@2888
   337
        /* Perform clipping */
slouken@3536
   338
        if (!SDL_IntersectRect(rect, &dst->clip_rect, &clipped)) {
slouken@3536
   339
            return 0;
slouken@2888
   340
        }
slouken@3536
   341
        rect = &clipped;
slouken@2888
   342
    } else {
slouken@3536
   343
        rect = &dst->clip_rect;
slouken@2888
   344
    }
slouken@2888
   345
slouken@2888
   346
    /* Perform software fill */
slouken@2888
   347
    if (!dst->pixels) {
icculus@7037
   348
        return SDL_SetError("SDL_FillRect(): You must lock the surface");
slouken@2888
   349
    }
slouken@2888
   350
slouken@3536
   351
    pixels = (Uint8 *) dst->pixels + rect->y * dst->pitch +
slouken@3536
   352
                                     rect->x * dst->format->BytesPerPixel;
slouken@2888
   353
slouken@2888
   354
    switch (dst->format->BytesPerPixel) {
slouken@2888
   355
    case 1:
slouken@2888
   356
        {
slouken@2888
   357
            color |= (color << 8);
slouken@2888
   358
            color |= (color << 16);
slouken@2888
   359
#ifdef __SSE__
slouken@2888
   360
            if (SDL_HasSSE()) {
slouken@3536
   361
                SDL_FillRect1SSE(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   362
                break;
slouken@2888
   363
            }
slouken@2888
   364
#endif
slouken@2888
   365
#ifdef __MMX__
slouken@2888
   366
            if (SDL_HasMMX()) {
slouken@3536
   367
                SDL_FillRect1MMX(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   368
                break;
slouken@2888
   369
            }
slouken@2888
   370
#endif
slouken@3536
   371
            SDL_FillRect1(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   372
            break;
slouken@2888
   373
        }
slouken@2888
   374
slouken@2888
   375
    case 2:
slouken@2888
   376
        {
slouken@2888
   377
            color |= (color << 16);
slouken@2888
   378
#ifdef __SSE__
slouken@2888
   379
            if (SDL_HasSSE()) {
slouken@3536
   380
                SDL_FillRect2SSE(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   381
                break;
slouken@2888
   382
            }
slouken@2888
   383
#endif
slouken@2888
   384
#ifdef __MMX__
slouken@2888
   385
            if (SDL_HasMMX()) {
slouken@3536
   386
                SDL_FillRect2MMX(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   387
                break;
slouken@2888
   388
            }
slouken@2888
   389
#endif
slouken@3536
   390
            SDL_FillRect2(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   391
            break;
slouken@2888
   392
        }
slouken@2888
   393
slouken@2888
   394
    case 3:
slouken@2888
   395
        /* 24-bit RGB is a slow path, at least for now. */
slouken@2888
   396
        {
slouken@3536
   397
            SDL_FillRect3(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   398
            break;
slouken@2888
   399
        }
slouken@2888
   400
slouken@2888
   401
    case 4:
slouken@2888
   402
        {
slouken@2888
   403
#ifdef __SSE__
slouken@2888
   404
            if (SDL_HasSSE()) {
slouken@3536
   405
                SDL_FillRect4SSE(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   406
                break;
slouken@2888
   407
            }
slouken@2888
   408
#endif
slouken@2888
   409
#ifdef __MMX__
slouken@2888
   410
            if (SDL_HasMMX()) {
slouken@3536
   411
                SDL_FillRect4MMX(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   412
                break;
slouken@2888
   413
            }
slouken@2888
   414
#endif
slouken@3536
   415
            SDL_FillRect4(pixels, dst->pitch, color, rect->w, rect->h);
slouken@2888
   416
            break;
slouken@2888
   417
        }
slouken@2888
   418
    }
slouken@2888
   419
slouken@2888
   420
    /* We're done! */
slouken@3536
   421
    return 0;
slouken@3536
   422
}
slouken@3536
   423
slouken@3536
   424
int
slouken@5297
   425
SDL_FillRects(SDL_Surface * dst, const SDL_Rect * rects, int count,
slouken@3536
   426
              Uint32 color)
slouken@3536
   427
{
slouken@3536
   428
    int i;
slouken@3536
   429
    int status = 0;
slouken@3536
   430
slouken@5297
   431
    if (!rects) {
icculus@7037
   432
        return SDL_SetError("SDL_FillRects() passed NULL rects");
slouken@5297
   433
    }
slouken@5297
   434
slouken@3536
   435
    for (i = 0; i < count; ++i) {
slouken@5297
   436
        status += SDL_FillRect(dst, &rects[i], color);
slouken@3536
   437
    }
slouken@3536
   438
    return status;
slouken@2888
   439
}
slouken@2888
   440
slouken@2888
   441
/* vi: set ts=4 sw=4 expandtab: */