arch/arm-all/arm-aeabi/llsr.c

   1 /*
   2     Copyright (C) 2009-2015, The AROS Development Team. All rights reserved.
   3     $Id$
   4  */
   5
   6 #include <inttypes.h>
   7
   8 uint64_t __aeabi_llsr(uint64_t val, int num)
   9 {
  10     union {
  11         uint64_t v64;
  12         struct {
  13             uint32_t lo;
  14             uint32_t hi;
  15         } v32;
  16     } u;
  17
  18     if (num == 0)
  19         return val;
  20
  21     if (num > 63)
  22         return 0;
  23
  24     u.v64 = val;
  25
  26     {
  27         if (num > 31)
  28         {
  29             u.v32.lo = u.v32.hi >> (num - 32);
  30             u.v32.hi = 0;
  31         }
  32         else
  33         {
  34             uint32_t reminder = u.v32.hi << (32-num);
  35             u.v32.lo = reminder | (u.v32.lo >> num);
  36             u.v32.hi >>= num;
  37         }
  38     }
  39
  40     return u.v64;
  41 }