/*
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.
*/

/* The nf bit fields of block are set to all ones. */

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

void setone(void *arg_block, long *fields, long *nf)
{
   long n, field_start, field_length;
   long i, byte1, bit1, bytel, bitl;
   BYTE mask, *block = arg_block;

   static BYTE leftzero[8] = {0xFF,0x7F,0x3F,0x1F,0x0F,0x07,0x03,0x01};
   static BYTE rightzero[8]= {0x80,0xC0,0xE0,0xF0,0xF8,0xFC,0xFE,0xFF};

   /* Process each bit field */
   for (n = *nf; n--;) {

      field_start = *fields++;
      --field_start;
      field_length = *fields++;

      /* Determine the first and last bytes */
      byte1 = field_start >> 3;
      bit1 = field_start % 8;
      bytel = (field_start+field_length-1) >> 3;
      bitl = (field_start+field_length-1) % 8;

      /* Bit string is contained in a single byte */
      if (byte1 == bytel) {
         mask = 0xFF;
         mask &= leftzero[bit1];
         mask &= rightzero[bitl];
         *(block+byte1) |= mask;
      }

      /* Bit string spans several bytes */
      else {
         /* Turn on bits in the first byte */
         *(block+byte1) |= leftzero[bit1];

         /* Turn on bits in the last byte */
         *(block+bytel) |= rightzero[bitl];

         /* Set in-between bytes to all ones */
         block += (byte1+1);
         for (i=bytel-byte1-1; i--;)
            *block++ = 0xFF;
      }
   }
}