libgfortran/m4/cshift1.m4

   1 `/* Implementation of the CSHIFT intrinsic
   2    Copyright 2003 Free Software Foundation, Inc.
   3    Contributed by Feng Wang <wf_cs@yahoo.com>
   4
   5 This file is part of the GNU Fortran 95 runtime library (libgfortran).
   6
   7 Libgfortran is free software; you can redistribute it and/or
   8 modify it under the terms of the GNU General Public
   9 License as published by the Free Software Foundation; either
  10 version 2 of the License, or (at your option) any later version.
  11
  12 In addition to the permissions in the GNU General Public License, the
  13 Free Software Foundation gives you unlimited permission to link the
  14 compiled version of this file into combinations with other programs,
  15 and to distribute those combinations without any restriction coming
  16 from the use of this file.  (The General Public License restrictions
  17 do apply in other respects; for example, they cover modification of
  18 the file, and distribution when not linked into a combine
  19 executable.)
  20
  21 Ligbfortran is distributed in the hope that it will be useful,
  22 but WITHOUT ANY WARRANTY; without even the implied warranty of
  23 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  24 GNU General Public License for more details.
  25
  26 You should have received a copy of the GNU General Public
  27 License along with libgfortran; see the file COPYING.  If not,
  28 write to the Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
  29 Boston, MA 02110-1301, USA.  */
  30
  31 #include "config.h"
  32 #include <stdlib.h>
  33 #include <assert.h>
  34 #include <string.h>
  35 #include "libgfortran.h"'
  36 include(iparm.m4)dnl
  37
  38 void cshift1_`'atype_kind (gfc_array_char * ret,
  39                            const gfc_array_char * array,
  40                            const atype * h, const atype_name * pwhich);
  41 export_proto(cshift1_`'atype_kind);
  42
  43 void
  44 cshift1_`'atype_kind (gfc_array_char * ret,
  45                       const gfc_array_char * array,
  46                       const atype * h, const atype_name * pwhich)
  47 {
  48   /* r.* indicates the return array.  */
  49   index_type rstride[GFC_MAX_DIMENSIONS];
  50   index_type rstride0;
  51   index_type roffset;
  52   char *rptr;
  53   char *dest;
  54   /* s.* indicates the source array.  */
  55   index_type sstride[GFC_MAX_DIMENSIONS];
  56   index_type sstride0;
  57   index_type soffset;
  58   const char *sptr;
  59   const char *src;
  60   /* h.* indicates the shift array.  */
  61   index_type hstride[GFC_MAX_DIMENSIONS];
  62   index_type hstride0;
  63   const atype_name *hptr;
  64
  65   index_type count[GFC_MAX_DIMENSIONS];
  66   index_type extent[GFC_MAX_DIMENSIONS];
  67   index_type dim;
  68   index_type size;
  69   index_type len;
  70   index_type n;
  71   int which;
  72   atype_name sh;
  73
  74   if (pwhich)
  75     which = *pwhich - 1;
  76   else
  77     which = 0;
  78
  79   if (which < 0 || (which + 1) > GFC_DESCRIPTOR_RANK (array))
  80     runtime_error ("Argument 'DIM' is out of range in call to 'CSHIFT'");
  81
  82   size = GFC_DESCRIPTOR_SIZE (ret);
  83
  84   if (ret->data == NULL)
  85     {
  86       int i;
  87
  88       ret->data = internal_malloc_size (size * size0 ((array_t *)array));
  89       ret->offset = 0;
  90       ret->dtype = array->dtype;
  91       for (i = 0; i < GFC_DESCRIPTOR_RANK (array); i++)
  92         {
  93           ret->dim[i].lbound = 0;
  94           ret->dim[i].ubound = array->dim[i].ubound - array->dim[i].lbound;
  95
  96           if (i == 0)
  97             ret->dim[i].stride = 1;
  98           else
  99             ret->dim[i].stride = (ret->dim[i-1].ubound + 1) * ret->dim[i-1].stride;
 100         }
 101     }
 102
 103   extent[0] = 1;
 104   count[0] = 0;
 105   size = GFC_DESCRIPTOR_SIZE (array);
 106   n = 0;
 107
 108   /* Initialized for avoiding compiler warnings.  */
 109   roffset = size;
 110   soffset = size;
 111   len = 0;
 112
 113   for (dim = 0; dim < GFC_DESCRIPTOR_RANK (array); dim++)
 114     {
 115       if (dim == which)
 116         {
 117           roffset = ret->dim[dim].stride * size;
 118           if (roffset == 0)
 119             roffset = size;
 120           soffset = array->dim[dim].stride * size;
 121           if (soffset == 0)
 122             soffset = size;
 123           len = array->dim[dim].ubound + 1 - array->dim[dim].lbound;
 124         }
 125       else
 126         {
 127           count[n] = 0;
 128           extent[n] = array->dim[dim].ubound + 1 - array->dim[dim].lbound;
 129           rstride[n] = ret->dim[dim].stride * size;
 130           sstride[n] = array->dim[dim].stride * size;
 131
 132           hstride[n] = h->dim[n].stride;
 133           n++;
 134         }
 135     }
 136   if (sstride[0] == 0)
 137     sstride[0] = size;
 138   if (rstride[0] == 0)
 139     rstride[0] = size;
 140   if (hstride[0] == 0)
 141     hstride[0] = 1;
 142
 143   dim = GFC_DESCRIPTOR_RANK (array);
 144   rstride0 = rstride[0];
 145   sstride0 = sstride[0];
 146   hstride0 = hstride[0];
 147   rptr = ret->data;
 148   sptr = array->data;
 149   hptr = h->data;
 150
 151   while (rptr)
 152     {
 153       /* Do the shift for this dimension.  */
 154       sh = *hptr;
 155       sh = (div (sh, len)).rem;
 156       if (sh < 0)
 157         sh += len;
 158
 159       src = &sptr[sh * soffset];
 160       dest = rptr;
 161
 162       for (n = 0; n < len; n++)
 163         {
 164           memcpy (dest, src, size);
 165           dest += roffset;
 166           if (n == len - sh - 1)
 167             src = sptr;
 168           else
 169             src += soffset;
 170         }
 171
 172       /* Advance to the next section.  */
 173       rptr += rstride0;
 174       sptr += sstride0;
 175       hptr += hstride0;
 176       count[0]++;
 177       n = 0;
 178       while (count[n] == extent[n])
 179         {
 180           /* When we get to the end of a dimension, reset it and increment
 181              the next dimension.  */
 182           count[n] = 0;
 183           /* We could precalculate these products, but this is a less
 184              frequently used path so proabably not worth it.  */
 185           rptr -= rstride[n] * extent[n];
 186           sptr -= sstride[n] * extent[n];
 187           hptr -= hstride[n] * extent[n];
 188           n++;
 189           if (n >= dim - 1)
 190             {
 191               /* Break out of the loop.  */
 192               rptr = NULL;
 193               break;
 194             }
 195           else
 196             {
 197               count[n]++;
 198               rptr += rstride[n];
 199               sptr += sstride[n];
 200               hptr += hstride[n];
 201             }
 202         }
 203     }
 204 }