#include "Hough2DNode.h"
#include <cmath>
#include <iostream>
#include "stdlib.h"



Hough2DNode::Hough2DNode(float* center, int level, int nHyperplanes) {
  _nPlanes = nHyperplanes;
  _hitList = (bool*) malloc(_nPlanes*sizeof(bool));
  _center = (float*) malloc(2*sizeof(float));
  _corners = (float*) malloc(8*sizeof(float));
  _votes = 0;
  _level = level;
  _center[0] = center[0];
  _center[1] = center[1];
  
  _length = 1.f/(pow(2,level));
  
  int count=0;
  for(int x=-1; x<2; x+=2)
    for(int y=-1; y<2; y+=2) {
      _corners[count*2] = _center[0] + 0.5*x*_length;
      _corners[count*2+1] = _center[1] + 0.5*y*_length;
      count++;
    }
  
     
}

float*
Hough2DNode::getSonArray() {   //return centers of sons
  float* arr = (float*) malloc(8*sizeof(float));
  int count=0;
  for(int x=-1; x<2; x+=2)
    for(int y=-1; y<2; y+=2) {
      arr[count*2] = _center[0] + 0.25*x*_length;
      arr[count*2+1] = _center[1] + 0.25*y*_length;
      count++;
    }
  
  return arr;
}

void
Hough2DNode::print() {
  
  std::cout<<"**Hough2DNode**   level: "<<_level<<"   center: "
	   <<_center[0]<<", "<<_center[1]<<"   votes: "
	   <<_votes<<std::endl; 

}