You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
178 lines
5.4 KiB
178 lines
5.4 KiB
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <math.h>
|
|
#include <float.h>
|
|
#include <string.h>
|
|
|
|
#include "serialDeclarations.h"
|
|
|
|
void get_args(int argc, char **argv, int *h){
|
|
if (argc != 6) {
|
|
printf("Usage: %s h N D Pd Pl\nwhere:\n", argv[0]);
|
|
printf("\th is the variance\n");
|
|
printf("\tN is the the number of points\n");
|
|
printf("\tD is the number of dimensions of each point\n");
|
|
printf("\tPd is the path of the dataset file\n");
|
|
printf("\tPl is the path of the labels file\n");
|
|
exit(1);
|
|
}
|
|
|
|
*h = atoi(argv[1]);
|
|
NUMBER_OF_POINTS = atoi(argv[2]);
|
|
DIMENSIONS = atoi(argv[3]);
|
|
POINTS_FILENAME = argv[4];
|
|
LABELS_FILENAME = argv[5];
|
|
}
|
|
|
|
int meanshift(double **originalPoints, double ***shiftedPoints, int h
|
|
, parameters *opt, int iteration){
|
|
|
|
// allocates space and copies original points on first iteration
|
|
if (iteration == 1){
|
|
(*shiftedPoints) = alloc_2d_double(NUMBER_OF_POINTS, DIMENSIONS);
|
|
(*shiftedPoints) = duplicate(originalPoints, (*shiftedPoints)
|
|
, NUMBER_OF_POINTS, DIMENSIONS);
|
|
}
|
|
|
|
// mean shift vector
|
|
double **meanShiftVector;
|
|
meanShiftVector = alloc_2d_double(NUMBER_OF_POINTS, DIMENSIONS);
|
|
// initialize elements of meanShiftVector to inf
|
|
for (int i=0;i<NUMBER_OF_POINTS;i++){
|
|
for (int j=0;j<DIMENSIONS;j++){
|
|
meanShiftVector[i][j] = DBL_MAX;
|
|
}
|
|
}
|
|
|
|
double **kernelMatrix = alloc_2d_double(NUMBER_OF_POINTS, NUMBER_OF_POINTS);
|
|
double *denominator = malloc(NUMBER_OF_POINTS * sizeof(double));
|
|
|
|
// find pairwise distance matrix (inside radius)
|
|
// [I, D] = rangesearch(x,y,h);
|
|
for (int i=0; i<NUMBER_OF_POINTS; i++){
|
|
double sum =0;
|
|
for (int j=0; j<NUMBER_OF_POINTS; j++){
|
|
double dist = calculateDistance((*shiftedPoints)[i],originalPoints[j]);
|
|
|
|
if (i == j){
|
|
kernelMatrix[i][j] = 1;
|
|
} else if (dist < h*h){
|
|
kernelMatrix[i][j] = dist * dist;
|
|
// compute kernel matrix
|
|
double pow = ((-1)*(kernelMatrix[i][j]))/(2*(h*h));
|
|
kernelMatrix[i][j] = exp(pow);
|
|
} else {
|
|
kernelMatrix[i][j] = 0;
|
|
}
|
|
sum = sum + kernelMatrix[i][j];
|
|
}
|
|
denominator[i] = sum;
|
|
}
|
|
|
|
// create new y vector
|
|
double **y_new = alloc_2d_double(NUMBER_OF_POINTS, DIMENSIONS);
|
|
|
|
multiply(kernelMatrix, originalPoints, y_new);
|
|
// divide element-wise
|
|
for (int i=0; i<NUMBER_OF_POINTS; i++){
|
|
for (int j=0; j<DIMENSIONS; j++){
|
|
y_new[i][j] = y_new[i][j] / denominator[i];
|
|
// calculate mean-shift vector
|
|
meanShiftVector[i][j] = y_new[i][j] - (*shiftedPoints)[i][j];
|
|
}
|
|
}
|
|
shiftedPoints = &y_new;
|
|
|
|
save_matrix((*shiftedPoints), iteration);
|
|
|
|
double current_norm = norm(meanShiftVector, NUMBER_OF_POINTS, DIMENSIONS);
|
|
printf("Iteration n. %d, error %f \n", iteration, current_norm);
|
|
|
|
/** iterate until convergence **/
|
|
if (current_norm > opt->epsilon) {
|
|
return meanshift(originalPoints, shiftedPoints, h, opt, ++iteration);
|
|
}
|
|
|
|
return iteration;
|
|
}
|
|
|
|
// TODO check why there's is a difference in the norm calculate in matlab
|
|
double norm(double **matrix, int rows, int cols){
|
|
double sum=0, tempMul=0;
|
|
for (int i=0; i<rows; i++) {
|
|
for (int j=0; j<cols; j++) {
|
|
tempMul = matrix[i][j] * matrix[i][j];
|
|
sum = sum + tempMul;
|
|
}
|
|
}
|
|
double norm = sqrt(sum);
|
|
return norm;
|
|
}
|
|
|
|
void multiply(double **matrix1, double **matrix2, double **output){
|
|
// W dims are NUMBER_OF_POINTS NUMBER_OF_POINTS
|
|
// and x dims are NUMBER_OF_POINTS DIMENSIONS
|
|
|
|
for (int i=0; i<NUMBER_OF_POINTS; i++){
|
|
for (int j=0; j<DIMENSIONS; j++){
|
|
output[i][j] = 0;
|
|
for (int k=0; k<NUMBER_OF_POINTS; k++){
|
|
output[i][j] += matrix1[i][k] * matrix2[k][j];
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
double calculateDistance(double *y, double *x){
|
|
double sum = 0, dif;
|
|
for (int i=0; i<DIMENSIONS; i++){
|
|
dif = y[i]-x[i];
|
|
sum += dif * dif;
|
|
}
|
|
double distance = sqrt(sum);
|
|
return distance;
|
|
}
|
|
|
|
// allocates a 2d array in continuous memory positions
|
|
double **alloc_2d_double(int rows, int cols) {
|
|
double *data = (double *) malloc(rows*cols*sizeof(double));
|
|
double **array = (double **) malloc(rows*sizeof(double*));
|
|
for (int i=0; i<rows; i++)
|
|
array[i] = &(data[cols*i]);
|
|
return array;
|
|
}
|
|
|
|
// copy the values of a 2d double array to another
|
|
double **duplicate(double **a, double **b, int rows, int cols){
|
|
for (int i=0; i<rows; i++){
|
|
for (int j=0; j<cols; j++){
|
|
b[i][j] = a[i][j];
|
|
}
|
|
}
|
|
return b;
|
|
}
|
|
|
|
void print_matrix(double **array, int rows, int cols){
|
|
for (int i=0; i<cols; i++){
|
|
for (int j=0; j<rows; j++){
|
|
printf("%f ", array[j][i]);
|
|
}
|
|
printf("\n");
|
|
}
|
|
}
|
|
|
|
void save_matrix(double **matrix, int iteration){
|
|
char filename[18];
|
|
snprintf(filename, sizeof(filename), "%s%d", "output/output_", iteration);
|
|
FILE *iterOutput;
|
|
iterOutput = fopen(filename, "w");
|
|
for (int rows=0; rows<NUMBER_OF_POINTS; ++rows){
|
|
for (int cols=0; cols<DIMENSIONS; ++cols){
|
|
fprintf(iterOutput, "%f", matrix[rows][cols]);
|
|
if (cols != DIMENSIONS - 1){
|
|
fprintf(iterOutput, ",");
|
|
}
|
|
}
|
|
fprintf(iterOutput, "\n");
|
|
}
|
|
}
|