Adapt GDB integration to newest patches
[bpt/guile.git] / libguile / array-map.c
index e4cb9c1..938f0a7 100644 (file)
@@ -1,6 +1,6 @@
 /* Copyright (C) 1996, 1998, 2000, 2001, 2004, 2005, 2006, 2008, 2009,
  *   2010, 2011, 2012, 2013, 2014 Free Software Foundation, Inc.
- * 
+ *
  * This library is free software; you can redistribute it and/or
  * modify it under the terms of the GNU Lesser General Public License
  * as published by the Free Software Foundation; either version 3 of
@@ -59,124 +59,23 @@ ASET (SCM v, size_t pos, SCM val)
   scm_c_array_set_1_x (v, val, pos);
 }
 
-/* Checker for scm_array mapping functions, returns:
-
-   5 --> empty axes;
-   4 --> shapes, increments, and bases are the same;
-   3 --> shapes and increments are the same;
-   2 --> shapes are the same;
-   1 --> ras are at least as big as ra0;
-   0 --> no match.
-   */
-
-int
-scm_ra_matchp (SCM ra0, SCM ras)
-{
-  int i, exact = 4, empty = 0;
-  scm_t_array_handle h0;
-
-  scm_array_get_handle (ra0, &h0);
-  for (i = 0; i < h0.ndims; ++i)
-    {
-      empty = empty || (h0.dims[i].lbnd > h0.dims[i].ubnd);
-    }
-
-  while (scm_is_pair (ras))
-    {
-      scm_t_array_handle h1;
-
-      scm_array_get_handle (SCM_CAR (ras), &h1);
-
-      if (h0.ndims != h1.ndims)
-        {
-          scm_array_handle_release (&h0);
-          scm_array_handle_release (&h1);
-          return 0;
-        }
-      if (h0.base != h1.base)
-        exact = min(3, exact);
-
-      for (i = 0; i < h0.ndims; ++i)
-        {
-          empty = empty || (h1.dims[i].lbnd > h1.dims[i].ubnd);
-          switch (exact)
-            {
-            case 4:
-            case 3:
-              if (h0.dims[i].inc != h1.dims[i].inc)
-                exact = 2;
-            case 2:
-              if (h0.dims[i].lbnd == h1.dims[i].lbnd && h0.dims[i].ubnd == h1.dims[i].ubnd)
-                break;
-              exact = 1;
-            default:
-              if (h0.dims[i].lbnd < h1.dims[i].lbnd || h0.dims[i].ubnd > h1.dims[i].ubnd)
-                {
-                  scm_array_handle_release (&h0);
-                  scm_array_handle_release (&h1);
-                  return 0;
-                }
-            }
-        }
-      scm_array_handle_release (&h1);
-      ras = SCM_CDR (ras);
-    }
-  scm_array_handle_release (&h0);
-  return empty ? 5 : exact;
-}
-
 static SCM
 make1array (SCM v, ssize_t inc)
 {
   SCM a = scm_i_make_array (1);
-  SCM_I_ARRAY_BASE (a) = 0;
+  SCM_I_ARRAY_SET_BASE (a, 0);
   SCM_I_ARRAY_DIMS (a)->lbnd = 0;
   SCM_I_ARRAY_DIMS (a)->ubnd = scm_c_array_length (v) - 1;
   SCM_I_ARRAY_DIMS (a)->inc = inc;
-  SCM_I_ARRAY_V (a) = v;
+  SCM_I_ARRAY_SET_V (a, v);
   return a;
 }
 
-/* Find down to which rank the array is unrollable. 0 means fully
-   unrollable, which all rank-0 and rank-1 arrays are. */
-static int
-find_unrollk (SCM ra, int k)
-{
-  if (k <= 0)
-    return 0;
-  else
-    {
-      ssize_t inc;
-      inc = SCM_I_ARRAY_DIMS (ra)[k].inc;
-      do {
-        size_t lenk = (SCM_I_ARRAY_DIMS (ra)[k].ubnd
-                       - SCM_I_ARRAY_DIMS (ra)[k].lbnd + 1);
-        inc *= lenk;
-        --k;
-      } while (k >= 0 && inc == SCM_I_ARRAY_DIMS (ra)[k].inc);
-      return k+1;
-    }
-}
-
-/* Length of the unrolled index set. */
-static size_t
-klen (SCM ra, int kbegin, int kend)
-{
-  size_t len = 1;
-  int k;
-  for (k = kbegin; k < kend; ++k)
-    len *= (SCM_I_ARRAY_DIMS (ra)[k].ubnd
-            - SCM_I_ARRAY_DIMS (ra)[k].lbnd + 1);
-  return len;
-}
-
-/* Linear index of the NOT unrolled index set. */
+/* Linear index of not-unrolled index set. */
 static size_t
 cindk (SCM ra, ssize_t *ve, int kend)
 {
-  if (!SCM_I_ARRAYP (ra))
-    return 0; /* this is BASE */
-  else
+  if (SCM_I_ARRAYP (ra))
     {
       int k;
       size_t i = SCM_I_ARRAY_BASE (ra);
@@ -184,6 +83,8 @@ cindk (SCM ra, ssize_t *ve, int kend)
         i += (ve[k] - SCM_I_ARRAY_DIMS (ra)[k].lbnd) * SCM_I_ARRAY_DIMS (ra)[k].inc;
       return i;
     }
+  else
+    return 0; /* this is BASE */
 }
 
 /* array mapper: apply cproc to each dimension of the given arrays?.
@@ -194,118 +95,143 @@ cindk (SCM ra, ssize_t *ve, int kend)
      SCM ra0;           destination array.
      SCM lra;           list of source arrays.
      const char *what;  caller, for error reporting. */
+
+#define LBND(ra, k) SCM_I_ARRAY_DIMS (ra)[k].lbnd
+#define UBND(ra, k) SCM_I_ARRAY_DIMS (ra)[k].ubnd
+
 int
 scm_ramapc (void *cproc_ptr, SCM data, SCM ra0, SCM lra, const char *what)
 {
-  SCM z;
-  SCM vra0;
-  SCM lvra, *plvra;
-  ssize_t *vi;
-  int k, kmax, unrollk;
   int (*cproc) () = cproc_ptr;
-  size_t unrolled_len;
+  SCM z, va0, lva, *plva;
+  int k, kmax, kroll;
+  ssize_t *vi, inc;
+  size_t len;
 
-  switch (scm_ra_matchp (ra0, lra))
+  /* Prepare reference argument. */
+  if (SCM_I_ARRAYP (ra0))
     {
-    default:
-    case 0:
-      scm_misc_error (what, "array shape mismatch: ~S", scm_list_1 (ra0));
-    case 1:
-    case 2:
-    case 3:
-    case 4:
+      kmax = SCM_I_ARRAY_NDIM (ra0)-1;
+      inc = kmax < 0 ?  0 : SCM_I_ARRAY_DIMS (ra0)[kmax].inc;
+      va0 = make1array (SCM_I_ARRAY_V (ra0), inc);
 
-      /* Prepare reference argument */
-      if (SCM_I_ARRAYP (ra0))
+      /* Find unroll depth */
+      for (kroll = max(0, kmax); kroll > 0; --kroll)
         {
-          kmax = SCM_I_ARRAY_NDIM (ra0)-1;
-          vra0 = make1array (SCM_I_ARRAY_V (ra0), SCM_I_ARRAY_DIMS (ra0)[kmax].inc);
+          inc *= (UBND (ra0, kroll) - LBND (ra0, kroll) + 1);
+          if (inc != SCM_I_ARRAY_DIMS (ra0)[kroll-1].inc)
+            break;
         }
-      else
+    }
+  else
+    {
+      kroll = kmax = 0;
+      va0 = ra0 = make1array (ra0, 1);
+    }
+
+  /* Prepare rest arguments. */
+  lva = SCM_EOL;
+  plva = &lva;
+  for (z = lra; !scm_is_null (z); z = SCM_CDR (z))
+    {
+      SCM va1, ra1 = SCM_CAR (z);
+      if (SCM_I_ARRAYP (ra1))
         {
-          kmax = 0;
-          vra0 = ra0 = make1array(ra0, 1);
-        }
+          if (kmax != SCM_I_ARRAY_NDIM (ra1) - 1)
+            scm_misc_error (what, "array shape mismatch: ~S", scm_list_1 (ra0));
+          inc = kmax < 0 ? 0 : SCM_I_ARRAY_DIMS (ra1)[kmax].inc;
+          va1 = make1array (SCM_I_ARRAY_V (ra1), inc);
+
+          /* Check unroll depth. */
+          for (k = kmax; k > kroll; --k)
+            {
+              ssize_t l0 = LBND (ra0, k), u0 = UBND (ra0, k);
+              if (l0 < LBND (ra1, k) || u0 > UBND (ra1, k))
+                scm_misc_error (what, "array shape mismatch: ~S", scm_list_1 (ra0));
+              inc *= (u0 - l0 + 1);
+              if (inc != SCM_I_ARRAY_DIMS (ra1)[k-1].inc)
+                {
+                  kroll = k;
+                  break;
+                }
+            }
 
-      /* Linear addressing for rest arguments */
-      lvra = SCM_EOL;
-      plvra = &lvra;
-      for (z = lra; !scm_is_null (z); z = SCM_CDR (z))
+          /* Check matching of not-unrolled axes. */
+          for (; k>=0; --k)
+            if (LBND (ra0, k) < LBND (ra1, k) || UBND (ra0, k) > UBND (ra1, k))
+              scm_misc_error (what, "array shape mismatch: ~S", scm_list_1 (ra0));
+        }
+      else
         {
-          SCM ra1 = SCM_CAR (z);
-          SCM vra1;
-          if (SCM_I_ARRAYP (ra1))
-            vra1 = make1array (SCM_I_ARRAY_V (ra1), SCM_I_ARRAY_DIMS (ra1)[kmax].inc);
-          else
-            vra1 = make1array (ra1, 1);
-          *plvra = scm_cons (vra1, SCM_EOL);
-          plvra = SCM_CDRLOC (*plvra);
+          if (kmax != 0)
+            scm_misc_error (what, "array shape mismatch: ~S", scm_list_1 (ra0));
+          va1 = make1array (ra1, 1);
+
+          if (LBND (ra0, 0) < LBND (va1, 0) || UBND (ra0, 0) > UBND (va1, 0))
+            scm_misc_error (what, "array shape mismatch: ~S", scm_list_1 (ra0));
         }
+      *plva = scm_cons (va1, SCM_EOL);
+      plva = SCM_CDRLOC (*plva);
+    }
 
-      /* Find common unroll depth */
-      unrollk = find_unrollk (ra0, kmax);
-      for (z = lra; !scm_is_null (z); z = SCM_CDR (z))
-       {
-          SCM ra1 = SCM_CAR (z);
-          unrollk = max(unrollk, find_unrollk (ra1, kmax));
-       }
-      unrolled_len = klen (ra0, unrollk, kmax+1);
+  /* Check emptiness of not-unrolled axes. */
+  for (k = 0; k < kroll; ++k)
+    if (0 == (UBND (ra0, k) - LBND (ra0, k) + 1))
+      return 1;
 
-      /* Set inner loop size */
-      SCM_I_ARRAY_DIMS (vra0)->lbnd = 0;
-      SCM_I_ARRAY_DIMS (vra0)->ubnd = unrolled_len - 1;
-      for (z = lvra; !scm_is_null (z); z = SCM_CDR (z))
+  /* Set unrolled size. */
+  for (len = 1; k <= kmax; ++k)
+    len *= (UBND (ra0, k) - LBND (ra0, k) + 1);
+  UBND (va0, 0) = len - 1;
+  for (z = lva; !scm_is_null (z); z = SCM_CDR (z))
+    UBND (SCM_CAR (z), 0) = len - 1;
+
+  /* Set starting indices and go. */
+  vi = scm_gc_malloc_pointerless (sizeof(ssize_t) * kroll, vi_gc_hint);
+  for (k = 0; k < kroll; ++k)
+    vi[k] = LBND (ra0, k);
+  do
+    {
+      if (k == kroll)
         {
-          SCM_I_ARRAY_DIMS (SCM_CAR (z))->lbnd = 0;
-          SCM_I_ARRAY_DIMS (SCM_CAR (z))->ubnd = unrolled_len - 1;
+          SCM y = lra;
+          SCM_I_ARRAY_SET_BASE (va0, cindk (ra0, vi, kroll));
+          for (z = lva; !scm_is_null (z); z = SCM_CDR (z), y = SCM_CDR (y))
+            SCM_I_ARRAY_SET_BASE (SCM_CAR (z), cindk (SCM_CAR (y), vi, kroll));
+          if (! (SCM_UNBNDP (data) ? cproc (va0, lva) : cproc (va0, data, lva)))
+            return 0;
+          --k;
         }
-
-      /* Set starting indices and go */
-      vi = scm_gc_malloc_pointerless (sizeof(ssize_t) * unrollk, vi_gc_hint);
-      for (k = 0; k < unrollk; ++k)
-        vi[k] = SCM_I_ARRAY_DIMS (ra0)[k].lbnd;
-      do
+      else if (vi[k] < UBND (ra0, k))
         {
-          if (k == unrollk)
-            {
-              SCM y = lra;
-              SCM_I_ARRAY_BASE (vra0) = cindk (ra0, vi, unrollk);
-              for (z = lvra; !scm_is_null (z); z = SCM_CDR (z), y = SCM_CDR (y))
-                SCM_I_ARRAY_BASE (SCM_CAR (z)) = cindk (SCM_CAR (y), vi, unrollk);
-              if (SCM_UNBNDP (data))
-                cproc (vra0, lvra);
-              else
-                cproc (vra0, data, lvra);
-              k--;
-            }
-          else if (vi[k] < SCM_I_ARRAY_DIMS (ra0)[k].ubnd)
-            {
-              vi[k]++;
-              k++;
-            }
-          else
-            {
-              vi[k] = SCM_I_ARRAY_DIMS (ra0)[k].lbnd - 1;
-              k--;
-            }
+          ++vi[k];
+          ++k;
+        }
+      else
+        {
+          vi[k] = LBND (ra0, k) - 1;
+          --k;
         }
-      while (k >= 0);
-
-    case 5:
-      return 1;
     }
+  while (k >= 0);
+
+  return 1;
 }
 
+#undef UBND
+#undef LBND
+
 static int
 rafill (SCM dst, SCM fill)
 {
-  long n = (SCM_I_ARRAY_DIMS (dst)->ubnd - SCM_I_ARRAY_DIMS (dst)->lbnd + 1);
   scm_t_array_handle h;
-  size_t i;
+  size_t n, i;
   ssize_t inc;
   scm_array_get_handle (SCM_I_ARRAY_V (dst), &h);
   i = SCM_I_ARRAY_BASE (dst);
   inc = SCM_I_ARRAY_DIMS (dst)->inc;
+  n = (SCM_I_ARRAY_DIMS (dst)->ubnd - SCM_I_ARRAY_DIMS (dst)->lbnd + 1);
+  dst = SCM_I_ARRAY_V (dst);
 
   for (; n-- > 0; i += inc)
     h.vset (h.vector, i, fill);
@@ -329,9 +255,8 @@ SCM_DEFINE (scm_array_fill_x, "array-fill!", 2, 0, 0,
 static int
 racp (SCM src, SCM dst)
 {
-  ssize_t n = (SCM_I_ARRAY_DIMS (src)->ubnd - SCM_I_ARRAY_DIMS (src)->lbnd + 1);
   scm_t_array_handle h_s, h_d;
-  size_t i_s, i_d;
+  size_t n, i_s, i_d;
   ssize_t inc_s, inc_d;
 
   dst = SCM_CAR (dst);
@@ -339,9 +264,12 @@ racp (SCM src, SCM dst)
   i_d = SCM_I_ARRAY_BASE (dst);
   inc_s = SCM_I_ARRAY_DIMS (src)->inc;
   inc_d = SCM_I_ARRAY_DIMS (dst)->inc;
+  n = (SCM_I_ARRAY_DIMS (src)->ubnd - SCM_I_ARRAY_DIMS (src)->lbnd + 1);
+  src = SCM_I_ARRAY_V (src);
+  dst = SCM_I_ARRAY_V (dst);
 
-  scm_array_get_handle (SCM_I_ARRAY_V (src), &h_s);
-  scm_array_get_handle (SCM_I_ARRAY_V (dst), &h_d);
+  scm_array_get_handle (src, &h_s);
+  scm_array_get_handle (dst, &h_d);
 
   if (h_s.element_type == SCM_ARRAY_ELEMENT_TYPE_SCM
       && h_d.element_type == SCM_ARRAY_ELEMENT_TYPE_SCM)
@@ -643,18 +571,17 @@ scm_array_identity (SCM dst, SCM src)
 static int
 ramap (SCM ra0, SCM proc, SCM ras)
 {
-  ssize_t i = SCM_I_ARRAY_DIMS (ra0)->lbnd;
-  size_t n = SCM_I_ARRAY_DIMS (ra0)->ubnd - i + 1;
-
   scm_t_array_handle h0;
-  size_t i0, i0end;
-  ssize_t inc0;
-  scm_array_get_handle (SCM_I_ARRAY_V (ra0), &h0);
+  size_t n, i0;
+  ssize_t i, inc0;
   i0 = SCM_I_ARRAY_BASE (ra0);
   inc0 = SCM_I_ARRAY_DIMS (ra0)->inc;
-  i0end = i0 + n*inc0;
+  i = SCM_I_ARRAY_DIMS (ra0)->lbnd;
+  n = SCM_I_ARRAY_DIMS (ra0)->ubnd - i + 1;
+  ra0 = SCM_I_ARRAY_V (ra0);
+  scm_array_get_handle (ra0, &h0);
   if (scm_is_null (ras))
-    for (; i0 < i0end; i0 += inc0)
+    for (; n--; i0 += inc0)
       h0.vset (h0.vector, i0, scm_call_0 (proc));
   else
     {
@@ -662,17 +589,18 @@ ramap (SCM ra0, SCM proc, SCM ras)
       scm_t_array_handle h1;
       size_t i1;
       ssize_t inc1;
-      scm_array_get_handle (SCM_I_ARRAY_V (ra1), &h1);
       i1 = SCM_I_ARRAY_BASE (ra1);
       inc1 = SCM_I_ARRAY_DIMS (ra1)->inc;
       ras = SCM_CDR (ras);
+      ra1 = SCM_I_ARRAY_V (ra1);
+      scm_array_get_handle (ra1, &h1);
       if (scm_is_null (ras))
-          for (; i0 < i0end; i0 += inc0, i1 += inc1)
-            h0.vset (h0.vector, i0, scm_call_1 (proc, h1.vref (h1.vector, i1)));
+        for (; n--; i0 += inc0, i1 += inc1)
+          h0.vset (h0.vector, i0, scm_call_1 (proc, h1.vref (h1.vector, i1)));
       else
         {
           ras = scm_vector (ras);
-          for (; i0 < i0end; i0 += inc0, i1 += inc1, ++i)
+          for (; n--; i0 += inc0, i1 += inc1, ++i)
             {
               SCM args = SCM_EOL;
               unsigned long k;
@@ -721,19 +649,19 @@ rafe (SCM ra0, SCM proc, SCM ras)
   size_t n = SCM_I_ARRAY_DIMS (ra0)->ubnd - i + 1;
 
   scm_t_array_handle h0;
-  size_t i0, i0end;
+  size_t i0;
   ssize_t inc0;
-  scm_array_get_handle (SCM_I_ARRAY_V (ra0), &h0);
   i0 = SCM_I_ARRAY_BASE (ra0);
   inc0 = SCM_I_ARRAY_DIMS (ra0)->inc;
-  i0end = i0 + n*inc0;
+  ra0 = SCM_I_ARRAY_V (ra0);
+  scm_array_get_handle (ra0, &h0);
   if (scm_is_null (ras))
-    for (; i0 < i0end; i0 += inc0)
+    for (; n--; i0 += inc0)
       scm_call_1 (proc, h0.vref (h0.vector, i0));
   else
     {
       ras = scm_vector (ras);
-      for (; i0 < i0end; i0 += inc0, ++i)
+      for (; n--; i0 += inc0, ++i)
         {
           SCM args = SCM_EOL;
           unsigned long k;
@@ -777,45 +705,46 @@ array_index_map_1 (SCM ra, SCM proc)
 static void
 array_index_map_n (SCM ra, SCM proc)
 {
+  scm_t_array_handle h;
   size_t i;
-  int j, k, kmax = SCM_I_ARRAY_NDIM (ra) - 1;
+  int k, kmax = SCM_I_ARRAY_NDIM (ra) - 1;
   ssize_t *vi;
+  SCM **si;
+  SCM args = SCM_EOL;
+  SCM *p = &args;
 
   vi = scm_gc_malloc_pointerless (sizeof(ssize_t) * (kmax + 1), vi_gc_hint);
+  si = scm_gc_malloc_pointerless (sizeof(SCM *) * (kmax + 1), vi_gc_hint);
 
   for (k = 0; k <= kmax; k++)
     {
       vi[k] = SCM_I_ARRAY_DIMS (ra)[k].lbnd;
       if (vi[k] > SCM_I_ARRAY_DIMS (ra)[k].ubnd)
         return;
+      *p = scm_cons (scm_from_ssize_t (vi[k]), SCM_EOL);
+      si[k] = SCM_CARLOC (*p);
+      p = SCM_CDRLOC (*p);
     }
 
+  scm_array_get_handle (ra, &h);
   k = kmax;
   do
     {
       if (k == kmax)
         {
-          SCM args = SCM_EOL;
-          SCM *p = &args, *q;
           vi[kmax] = SCM_I_ARRAY_DIMS (ra)[kmax].lbnd;
           i = cindk (ra, vi, kmax+1);
-          for (j = 0; j<=kmax; ++j)
+          for (; vi[kmax] <= SCM_I_ARRAY_DIMS (ra)[kmax].ubnd; ++vi[kmax])
             {
-              *p = scm_cons (scm_from_ssize_t (vi[j]), SCM_EOL);
-              q = SCM_CARLOC (*p);
-              p = SCM_CDRLOC (*p);
-            }
-          for (; vi[kmax] <= SCM_I_ARRAY_DIMS (ra)[kmax].ubnd;
-               *q = scm_from_ssize_t (++vi[kmax]))
-            {
-              ASET (SCM_I_ARRAY_V (ra), i, scm_apply_0 (proc, args));
+              *(si[kmax]) = scm_from_ssize_t (vi[kmax]);
+              h.vset (h.vector, i, scm_apply_0 (proc, args));
               i += SCM_I_ARRAY_DIMS (ra)[kmax].inc;
             }
           k--;
         }
       else if (vi[k] < SCM_I_ARRAY_DIMS (ra)[k].ubnd)
         {
-          vi[k]++;
+          *(si[k]) = scm_from_ssize_t (++vi[k]);
           k++;
         }
       else
@@ -825,6 +754,7 @@ array_index_map_n (SCM ra, SCM proc)
         }
     }
   while (k >= 0);
+  scm_array_handle_release (&h);
 }
 
 SCM_DEFINE (scm_array_index_map_x, "array-index-map!", 2, 0, 0,
@@ -885,7 +815,7 @@ array_compare (scm_t_array_handle *hx, scm_t_array_handle *hy,
         return 0;
 
       i = hx->dims[dim].ubnd - hx->dims[dim].lbnd + 1;
-      
+
       incx = hx->dims[dim].inc;
       incy = hy->dims[dim].inc;
       posx += (i - 1) * incx;
@@ -902,11 +832,11 @@ SCM
 scm_array_equal_p (SCM x, SCM y)
 {
   scm_t_array_handle hx, hy;
-  SCM res;  
-  
+  SCM res;
+
   scm_array_get_handle (x, &hx);
   scm_array_get_handle (y, &hy);
-  
+
   res = scm_from_bool (hx.ndims == hy.ndims
                        && hx.element_type == hy.element_type);
 
@@ -930,7 +860,7 @@ SCM_DEFINE (scm_i_array_equal_p, "array-equal?", 0, 2, 1,
 {
   if (SCM_UNBNDP (ra0) || SCM_UNBNDP (ra1))
     return SCM_BOOL_T;
-  
+
   while (!scm_is_null (rest))
     { if (scm_is_false (scm_array_equal_p (ra0, ra1)))
         return SCM_BOOL_F;