/*
Copyright (c) 2003, Dan Kranz and Arnold Rom
All rights reserved.

Redistribution and use in source and binary forms, with or
without modification, are permitted provided that the following
conditions are met:

    * Redistributions of source code must retain the above
      copyright notice, this list of conditions and the following
      disclaimer.

    * Redistributions in binary form must reproduce the above
      copyright notice, this list of conditions and the following
      disclaimer in the documentation and/or other materials
      provided with the distribution.

    * The names of its contributors may not be used to endorse or
      promote products derived from this software without specific
      prior written permission.

THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,
INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/

/*  Block's lines are physically re-arranged according to the sequence
    expressed by sorti; i.e. block(sorti(i)) is moved to block(i).

    The output block replaces the input block.
*/

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <roots.h>

void srmove(long *sorti, void *block, long *cpl, long *nline)
{
   long i, from, bfrom, to, n;
   BYTE *bpt, *buffer;
   BYTE *vacant, *full;

   /* Adjust and verify arguments */
   --sorti;
   if (*cpl < 1) {
      RootsSOS("srmove(): cpl < 1");
      abort();
   }
   n = *cpl;
   bpt = (BYTE*) block;
   bpt -= n;
   if (*nline == 0)
      return;
   if (*nline < 0) {
      RootsSOS("srmove(): nline < 0");
      abort();
   }

   ExpandGeneric(BYTE,buffer,*cpl);

   /* Flag buffer empty to start with */
   bfrom = 0;

   /* Sequential scan over all sorti */
   for (i=1; i <= *nline; i++) {
      to=i;

      /* Look for a block(to) line that needs to be replaced */
      if (!(*(sorti+to) & 0x80000000)) {
         from = *(sorti+to);

         /* Candidate in proper slot, flag as complete */
         if (from==to) {
            *(sorti+to) |= 0x80000000;
         }
         
         /* sorti directed move sequence */

         else {
            if (bfrom != 0) {
               RootsSOS("srmove(): Bad sorti array.");
               free(buffer);
               abort();
            }
            
            /* Move block(i) to vacant buffer */
            bfrom = to;
            vacant = bpt + (to*n);
            memcpy(buffer,vacant,n);

            do {
               full = bpt + (from*n);
               memcpy(vacant,full,n);

               /* Move to new vacancy */
               vacant = full;
               *(sorti+to) |= 0x80000000;
               to = from;
               from = *(sorti+to);

            /* Untouched entry? */
            } while (! (*(sorti+from) & 0x80000000));

            /* Cycle is complete */

            if (from != bfrom) {
               RootsSOS("srmove(): Bad sorti array.");
               free(buffer);
               abort();
            }

            /* Fill block(to) with buffer this time */
            memcpy(vacant,buffer,n);
            *(sorti+to) |= 0x80000000;
            bfrom=0;
         }
      }
   }
   free(buffer);

   /* Clean up sorti flag bytes */
   for (i=1; i <= *nline; i++)
      *(sorti+i) &= 0x7FFFFFFF;
   return;
}