summaryrefslogtreecommitdiffstats
path: root/qemu/roms/qemu-palcode/memset.c
blob: e8481dc9c652ec9d74200678137413698388f876 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
/* The standard memset function.

   Copyright (C) 2011 Richard Henderson

   This file is part of QEMU PALcode.

   This program is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License as published by
   the Free Software Foundation; either version 2 of the License or
   (at your option) any later version.

   This program is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the text
   of the GNU General Public License for more details.

   You should have received a copy of the GNU General Public License
   along with this program; see the file COPYING.  If not see
   <http://www.gnu.org/licenses/>.  */


#include <string.h>

void *memset(void *optr, int ival, unsigned long size)
{
  unsigned long val = ival;
  void *ptr = optr;

  if (__builtin_expect (size == 0, 0))
    return optr;

  if (__builtin_expect (val != 0, 0))
    {
      val = val & 0xff;
      val |= val << 8;
      val |= val << 16;
      val |= val << 32;
    }

  if (__builtin_expect ((unsigned long)ptr & 1, 0))
    {
      *(char *)ptr = val;
      ptr += 1;
      size -= 1;
    }

  if (__builtin_expect ((unsigned long)ptr & 2, 0))
    {
      if (size < 2)
	goto tail_1;
      *(short *)ptr = val;
      ptr += 2;
      size -= 2;
    }

  if (__builtin_expect ((unsigned long)ptr & 4, 0))
    {
      if (size < 4)
	goto tail_3;
      *(int *)ptr = val;
      ptr += 4;
      size -= 4;
    }
  
  while (size >= 8)
    {
      *(long *)ptr = val;
      ptr += 8;
      size -= 8;
    }

  if (size >= 4)
    {
      *(int *)ptr = val;
      ptr += 4;
      size -= 4;
    }

 tail_3:
  if (size >= 2)
    {
      *(short *)ptr = val;
      ptr += 2;
      size -= 2;
    }

 tail_1:
  if (size > 0)
    {
      *(char *)ptr = val;
      ptr += 1;
      size -= 1;
    }

  return optr;
}