Add qemu 2.4.0

[kvmfornfv.git] / qemu / roms / qemu-palcode / memset.c

diff --git a/qemu/roms/qemu-palcode/memset.c b/qemu/roms/qemu-palcode/memset.c
new file mode 100644 (file)
index 0000000..e8481dc
--- /dev/null
+++ b/qemu/roms/qemu-palcode/memset.c
@@ -0,0 +1,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;
+}