Mindboards

Code: Select all

#define DEBUG_Q 1
struct Qdata
{
  long x,y,z;
};
#define QTYPE Qdata
int handle; // File for testing
int tmp_cnt;
string tmp_str;
struct Q_t
{
  u8 size;
  u8 num;
  u8 wpos;
  u8 rpos;
  QTYPE data[];
};



void InitQueueM(const u8 &Size, Q_t &this)
{
  this.size = Size;
  QTYPE zero;
  ArrayInit(this.data,zero,Size);
  #if DEBUG_Q
  // Write out column headings
  tmp_str = FormatNum("InitQueue of size %d",this.size);
  WriteLnString(handle,tmp_str,tmp_cnt);

  tmp_str = "Command,Value,";
  for(int st=0;st<Size;st++)
  {
    tmp_str += FormatNum("Index %d,",st);
  }
  tmp_str += "Write Index,Read Index,Number of Entries";
  WriteLnString(handle,tmp_str,tmp_cnt);
  #endif

  
}

u8 push(const QTYPE &z, Q_t &this)
{
  //Returns number of entries, Zero on failure
  // copy out struct members
  u8 tmp_num  = this.num;
  u8 tmp_wpos = this.wpos;
  u8 tmp_size = this.size;

  if (tmp_num >= tmp_size)
  {
    #if DEBUG_Q
    WriteLnString(handle,"QUEUE FULL",tmp_cnt);
    #endif
    return 0;
  }
  this.data[tmp_wpos]= z;
  ++tmp_wpos;
  if (tmp_wpos >= tmp_size) tmp_wpos = 0;
  ++tmp_num;
  // copy back to struct
  this.num = tmp_num;
  this.wpos = tmp_wpos;
  #if DEBUG_Q
  // Write out value to file for testing
  tmp_str = FormatNum("push,%2d-",z.x);
  tmp_str += FormatNum("%2d-",z.y);
  tmp_str += FormatNum("%2d,",z.z);
  for(int d=0;d<this.size;d++)
  {
    tmp_str+=FormatNum("%2d-",this.data[d].x);
    tmp_str+=FormatNum("%2d-",this.data[d].y);
    tmp_str+=FormatNum("%2d,",this.data[d].z);
  };
  tmp_str += FormatNum("%2d,",this.wpos);
  tmp_str += FormatNum("%2d,",this.rpos);
  tmp_str += FormatNum("%2d,",this.num);

  WriteLnString(handle,tmp_str,tmp_cnt);
  // END Write out value to file for testing
  #endif
  return tmp_num;
}



u8 peek(QTYPE &z, Q_t &this)
{
 //Function returns number of entries
 // if zero, z is undefined
  z = this.data[this.rpos];
  return this.num;
}

u8 pop(QTYPE &z, Q_t &this)
{
  //Return number of entries before pop
  //if zero queue was empty
  u8 ret = this.num;

  // copy data out of struct
  u8 tmp_num = ret;
  u8 tmp_rpos = this.rpos;
  u8 tmp_size = this.size;
  if(ret <> 0)
  {
    z = this.data[tmp_rpos];
    QTYPE zero;
    this.data[tmp_rpos] = zero;
    ++tmp_rpos;
    if(tmp_rpos >= tmp_size) tmp_rpos = 0;
    --tmp_num;
  }else
  {
    #if DEBUG_Q
    WriteLnString(handle,"QUEUE EMPTY",tmp_cnt);
    #endif
    return ret;
  }
  // copy back to struct
  this.num = tmp_num;
  this.rpos = tmp_rpos;
  #if DEBUG_Q
  // Write out value to file for testing
  tmp_str = FormatNum("pop,%2d-",z.x);
  tmp_str += FormatNum("%2d-",z.y);
  tmp_str += FormatNum("%2d,",z.z);
  for(int d=0;d<this.size;d++)
  {
    tmp_str+=FormatNum("%2d-",this.data[d].x);
    tmp_str+=FormatNum("%2d-",this.data[d].y);
    tmp_str+=FormatNum("%2d,",this.data[d].z);
  };
  tmp_str += FormatNum("%2d,",this.wpos);
  tmp_str += FormatNum("%2d,",this.rpos);
  tmp_str += FormatNum("%2d,",this.num);

  WriteLnString(handle,tmp_str,tmp_cnt);
  // END Write out value to file for testing
  #endif
  return ret;
}

task main()
{
  QTYPE tmp;
  DeleteFile("qstruct.csv");
  CreateFile("qstruct.csv", 8192, handle);
  Q_t myQ;
  
  InitQueueM(5,myQ);
  tmp.x = 100;
  tmp.y = 55;
  tmp.z = 33;
  push(tmp,myQ);
  tmp.x = 99;
  tmp.y = 54;
  tmp.z = 32;
  push(tmp,myQ);
  
  pop(tmp,myQ);
  pop(tmp,myQ);

}

Code: Select all

int* x=&y;
*x=5;
// Now to corrupt some memory, just for kicks ;)
x=0xAAAA
*x=1234