Beaucoup modifs cosmétiques et ajouts dans GuiNuMo

Partout où cela était possible :
* Indentation "Emacs" du code, aération.
* Utilisation de #define pour les valeurs par défaut.
* Utilisation des valeurs par défaut dans les constructeurs.

server.cc/hh :
* Gestion d'erreur basique pour les ouvertures de fichiers.

Ajout du TODO, d'après celui fait par Fred sous format papier.

Création des répertoires :
* cfg : fichiers de configuration.
* csv : fichiers d'entrée.
* log : fichiers de sortie.

git-svn-id: https://pif.pu-pm.univ-fcomte.fr/svn/loc@28 785a6c6c-259e-4ff1-8b91-dc31627914f0
This commit is contained in:
Matteo Cypriani 2008-04-15 10:19:15 +00:00
parent f273cba513
commit f5292a5dd6
18 changed files with 401 additions and 381 deletions

View File

@ -30,6 +30,7 @@ test: test.o point.o measurement.o accesspoint.o referencepoint.o clientinfo.o s
$(LD) $(LDFLAGS) -o test test.o point.o measurement.o accesspoint.o referencepoint.o clientinfo.o server.o
clean:
rm -fv *~
rm -fv *.o
rm -fv test
@rm -fv *~ *.o
purge : clean
@rm -fv test

24
GuiNuMo-server/TODO Normal file
View File

@ -0,0 +1,24 @@
* Measurement :
→ RÀS
* Point :
→ RÀS
* ReferencePoint :
→ RÀS pour l'instant.
* ClientInfo : classe qui doit contenir les données des utilisateurs.
- IP,
- Socket,
→ plus tard, pour une vraie démo.
- Historique Viterbi,
→ à faire maintenant.
* Server :
→ Mettre à jour les algos de Viterbi (3 au total).
* Area : déf. des zones & waypoints entre les zones. Une zone = 2 points.
→ Ajouter au serveur la gestion des connexités entre les zones + graphe qui s'étend (cf. avec les points de référence pour l'algo).
→ Faire la fonction qui calcule les matrices étendues en utilisant :
° la matrice de distances entre les points de connexité ;
° les distances euclidiennes entre les points après FBCM et les points de connexité.

View File

@ -1,67 +1,58 @@
#include "accesspoint.hh"
AccessPoint::AccessPoint()
{
coordinates.setX(0);
coordinates.setY(0);
coordinates.setZ(0);
ap_addr = "";
friis_index = 0;
freq = 2412;
antenna_gain = 2; //a good value
output_power = 20; //another good value, eq. to 100mW
}
AccessPoint::AccessPoint(string addr, float fidx, Point coords, unsigned int f, float antg, float outp)
{
coordinates = coords;
ap_addr = addr;
friis_index = fidx;
freq = f;
antenna_gain = antg;
output_power = outp;
coordinates = coords;
ap_addr = addr;
friis_index = fidx;
freq = f;
antenna_gain = antg;
output_power = outp;
//cout << "coords = " << coords << " ; addr = " << addr << " ; fidx = " << fidx << " ; antg = " << antg << " ; outp = " << outp << endl ;
}
AccessPoint::AccessPoint(const AccessPoint &ap)
{
coordinates = ap.coordinates;
ap_addr = ap.ap_addr;
friis_index = ap.friis_index;
freq = ap.freq;
antenna_gain = ap.antenna_gain;
output_power = ap.output_power;
coordinates = ap.coordinates;
ap_addr = ap.ap_addr;
friis_index = ap.friis_index;
freq = ap.freq;
antenna_gain = ap.antenna_gain;
output_power = ap.output_power;
}
bool AccessPoint::operator==(const AccessPoint &ap)const
{
if(ap_addr == ap.ap_addr)
return true;
return false;
if(ap_addr == ap.ap_addr)
return true;
return false;
}
bool AccessPoint::operator!=(const AccessPoint &ap)const
{
if(ap_addr != ap.ap_addr)
return true;
return false;
if(ap_addr != ap.ap_addr)
return true;
return false;
}
AccessPoint AccessPoint::operator=(const AccessPoint &ap)
{
if(this == &ap)
return *this;
ap_addr = ap.ap_addr;
friis_index = ap.friis_index;
return *this;
if(this == &ap)
return *this;
ap_addr = ap.ap_addr;
friis_index = ap.friis_index;
return *this;
}
ostream &operator<<(ostream & os, AccessPoint & ap)
{
os << "MAC Address: " << ap.ap_addr << endl;
os << "Coordinates: " << ap.coordinates << endl;
os << "Frequency: " << ap.freq << " Hz" << endl;
os << "Antenna gain: " << ap.antenna_gain << "dBi" << endl;
os << "Output power: " << ap.output_power << "dBm" << endl;
os << "MAC Address: " << ap.ap_addr << endl;
os << "Coordinates: " << ap.coordinates << endl;
os << "Frequency: " << ap.freq << " Hz" << endl;
os << "Antenna gain: " << ap.antenna_gain << "dBi" << endl;
os << "Output power: " << ap.output_power << "dBm" << endl;
return os;
return os;
}

View File

@ -8,38 +8,43 @@
using namespace std;
using std::string;
#define AP_DEFAULT_ADDR ""
#define AP_DEFAULT_FRIIS_INDEX 0
#define AP_DEFAULT_FREQ 2412
#define AP_DEFAULT_ANTENNA_GAIN 2 // A good value
#define AP_DEFAULT_OUTPUT_POWER 20 // Another good value, eq. to 100mW
class AccessPoint
{
protected:
Point coordinates;
string ap_addr;
float friis_index;
unsigned int freq;
float antenna_gain;
float output_power;
protected:
Point coordinates;
string ap_addr;
float friis_index;
unsigned int freq;
float antenna_gain;
float output_power;
public:
AccessPoint();
AccessPoint(string addr, float fidx, Point coords, unsigned int f, float antg, float outp);
AccessPoint(const AccessPoint &ap);
~AccessPoint() {};
string getApAddr()const { return ap_addr; };
float getFriisIndex()const { return friis_index; };
Point getCoordinates()const { return coordinates; };
float getAntennaGain()const { return antenna_gain; };
unsigned int getFrequency()const { return freq; };
float getOutputPower()const { return output_power; };
void setApAddr(string addr) { ap_addr = addr; };
void setFriisIndex(float fidx) { friis_index = fidx; };
void setCoordinates(Point apc) { coordinates = apc; };
void setCoordinates(float x, float y, float z) { Point apc(x, y, z); coordinates = apc; };
void setFrequency(unsigned int f) { freq = f; };
void setAntennaGain(float antg) { antenna_gain = antg; };
void setOutputPower(float outp) {output_power = outp; };
bool operator==(const AccessPoint &ap)const;
bool operator!=(const AccessPoint &ap)const;
AccessPoint operator=(const AccessPoint &ap);
friend ostream &operator<<(ostream & os, AccessPoint & ap);
public:
AccessPoint(string addr = AP_DEFAULT_ADDR, float fidx = AP_DEFAULT_FRIIS_INDEX, Point coords = Point(), unsigned int f = AP_DEFAULT_FREQ, float antg = AP_DEFAULT_ANTENNA_GAIN, float outp = AP_DEFAULT_OUTPUT_POWER);
AccessPoint(const AccessPoint &ap);
~AccessPoint() {};
string getApAddr()const { return ap_addr; };
float getFriisIndex()const { return friis_index; };
Point getCoordinates()const { return coordinates; };
float getAntennaGain()const { return antenna_gain; };
unsigned int getFrequency()const { return freq; };
float getOutputPower()const { return output_power; };
void setApAddr(string addr) { ap_addr = addr; };
void setFriisIndex(float fidx) { friis_index = fidx; };
void setCoordinates(Point apc) { coordinates = apc; };
void setCoordinates(float x, float y, float z) { Point apc(x, y, z); coordinates = apc; };
void setFrequency(unsigned int f) { freq = f; };
void setAntennaGain(float antg) { antenna_gain = antg; };
void setOutputPower(float outp) {output_power = outp; };
bool operator==(const AccessPoint &ap)const;
bool operator!=(const AccessPoint &ap)const;
AccessPoint operator=(const AccessPoint &ap);
friend ostream &operator<<(ostream & os, AccessPoint & ap);
};
#endif

View File

@ -1,41 +1,36 @@
#include "area.hh"
Area::Area()
{
area_name = "None";
x_min = 0;
x_max = 0;
y_min = 0;
y_max = 0;
z_min = 0;
z_max = 0;
}
Area::Area(string an, float x1, float x2, float y1, float y2, float z1, float z2)
{
area_name = an;
x_min = x1;
x_max = x2;
y_min = y1;
y_max = y2;
z_min = z1;
z_max = z2;
area_name = an;
x_min = x1;
x_max = x2;
y_min = y1;
y_max = y2;
z_min = z1;
z_max = z2;
}
Area::Area(const Area &a)
{
area_name = a.area_name;
x_min = a.x_min;
x_max = a.x_max;
y_min = a.y_min;
y_max = a.y_max;
z_min = a.z_min;
z_max = a.z_max;
area_name = a.area_name;
x_min = a.x_min;
x_max = a.x_max;
y_min = a.y_min;
y_max = a.y_max;
z_min = a.z_min;
z_max = a.z_max;
}
bool Area::containsPoint(Point p)const
{
if((p.getX()>=x_min)&&(p.getX()<=x_max)&&(p.getY()>=y_min)&&(p.getY()<=y_max)&&(p.getZ()>=z_min)&&(p.getZ()<=z_max))
return true;
return false;
if((p.getX() >= x_min) \
&& (p.getX() <= x_max) \
&& (p.getY() >= y_min) \
&& (p.getY() <= y_max) \
&& (p.getZ() >= z_min) \
&& (p.getZ() <= z_max))
return true;
return false;
}

View File

@ -10,34 +10,33 @@ using std::string;
class Area
{
protected:
string area_name;
float x_min;
float x_max;
float y_min;
float y_max;
float z_min;
float z_max;
string area_name;
float x_min;
float x_max;
float y_min;
float y_max;
float z_min;
float z_max;
public:
Area();
Area(string an, float x1, float x2, float y1, float y2, float z1, float z2);
Area(const Area &a);
~Area() {};
bool containsPoint(Point p)const;
string getLabel()const { return label; };
float getXmin()const { return x_min; };
float getXmax()const { return x_max; };
float getYmin()const { return y_min; };
float getYmax()const { return y_max; };
float getZmin()const { return z_min; };
float getZmax()const { return z_max; };
void setLabel(string l) { label = l; };
void setXmin(float v) { x_min = v; };
void setXmax(float v) { x_max = v; };
void setYmin(float v) { y_min = v; };
void setYmax(float v) { y_max = v; };
void setZmin(float v) { z_min = v; };
void setZmax(float v) { z_max = v; };
Area(string an = "None", float x1 = 0, float x2 = 0, float y1 = 0, float y2 = 0, float z1 = 0, float z2 = 0);
Area(const Area &a);
~Area() {};
bool containsPoint(Point p)const;
string getLabel()const { return label; };
float getXmin()const { return x_min; };
float getXmax()const { return x_max; };
float getYmin()const { return y_min; };
float getYmax()const { return y_max; };
float getZmin()const { return z_min; };
float getZmax()const { return z_max; };
void setLabel(string l) { label = l; };
void setXmin(float v) { x_min = v; };
void setXmax(float v) { x_max = v; };
void setYmin(float v) { y_min = v; };
void setYmax(float v) { y_max = v; };
void setZmin(float v) { z_min = v; };
void setZmax(float v) { z_max = v; };
};
#endif

View File

@ -1,20 +1,13 @@
#include "clientinfo.hh"
ClientInfo::ClientInfo()
{
client_ip = "127.0.0.1";
antenna_gain = 2; //good default value
client_listen_port = CLIENT_DEFAULT_PORT;
for(int i=0;i<5;i++)
viterbi_distances[i] = 0;
}
ClientInfo::ClientInfo(string ip, int port, float antg)
{
client_ip = ip;
antenna_gain = antg;
client_listen_port = port;
for(int i=0;i<5;i++)
for(int i=0 ; i < 5 ; i++)
viterbi_distances[i] = 0;
}

View File

@ -10,6 +10,8 @@ using namespace std;
using std::string;
#define CLIENT_DEFAULT_PORT 7778
#define CLIENT_DEFAULT_IP "127.0.0.1"
#define CLIENT_DEFAULT_ANTENNA_GAIN 2 // Good default value
class ClientInfo
{
@ -17,13 +19,12 @@ protected:
string client_ip;
float antenna_gain;
int client_listen_port;
vector<Point> viterbi_vector1; /* Previous vector */
vector<Point> viterbi_vector2; /* Last vector */
vector<Point> viterbi_vector1; // Previous vector
vector<Point> viterbi_vector2; // Last vector
float viterbi_distances[5];
public:
ClientInfo();
ClientInfo(string ip, int port, float antg);
ClientInfo(string ip = CLIENT_DEFAULT_IP, int port = CLIENT_DEFAULT_PORT, float antg = CLIENT_DEFAULT_ANTENNA_GAIN);
~ClientInfo();
float getAntennaGain()const { return antenna_gain; };
};

View File

@ -2,32 +2,32 @@
void Measurement::addSsValue(int ssv)
{
float ss_mwatts = pow(10, (float) ssv / 10.0) + (ss_list.size() * pow(10, average_ss / 10.0));
float ss_mwatts = pow(10, (float) ssv / 10.0) + (ss_list.size() * pow(10, average_ss / 10.0));
ss_list.push_back(ssv);
average_ss = 10 * log10(ss_mwatts / ss_list.size());
ss_list.push_back(ssv);
average_ss = 10 * log10(ss_mwatts / ss_list.size());
}
float Measurement::getSsSquareDistance(float ss)const
{
return ((ss - average_ss) * (ss - average_ss));
return ((ss - average_ss) * (ss - average_ss));
}
ostream &operator<<(ostream &os, Measurement &m)
{
unsigned int i;
unsigned int i;
os << m.mac_addr << "->";
if(m.ss_list.size() == 0)
os << "No values";
else
for(i=0;i<m.ss_list.size();i++)
{
os << m.ss_list[i];
if(i < m.ss_list.size() - 1)
os << ";";
}
os << " [AVG=" << m.average_ss << "]";
os << m.mac_addr << "->";
if (m.ss_list.size() == 0)
os << "No values";
else
for (i = 0 ; i < m.ss_list.size() ; i++)
{
os << m.ss_list[i];
if(i < m.ss_list.size() - 1)
os << ";";
}
os << " [AVG=" << m.average_ss << "]";
return os;
return os;
}

View File

@ -11,23 +11,22 @@ using std::string;
class Measurement
{
protected:
string mac_addr;
float average_ss;
vector<int> ss_list;
protected:
string mac_addr;
float average_ss;
vector<int> ss_list;
public:
Measurement() { mac_addr = "ff:ff:ff:ff:ff:ff"; average_ss = 0; };
Measurement(string ma, float avg, vector<int> ssl) { mac_addr = ma; average_ss = avg, ss_list = ssl; };
Measurement(const Measurement &m) { mac_addr = m.mac_addr; average_ss = m.average_ss; ss_list = m.ss_list; };
~Measurement() { ss_list.clear(); };
vector<int> getSsList()const { return ss_list; };
float getAverage()const { return average_ss; };
string getMacAddr()const { return mac_addr; };
void addSsValue(int ssv);
void setMacAddr(string ma) { mac_addr = ma; };
float getSsSquareDistance(float ss)const;
friend ostream &operator<<(ostream &os, Measurement &m);
public:
Measurement(string ma = "ff:ff:ff:ff:ff:ff", float avg = 0, vector<int> ssl = vector<int>()) { mac_addr = ma; average_ss = avg, ss_list = ssl; };
Measurement(const Measurement &m) { mac_addr = m.mac_addr; average_ss = m.average_ss; ss_list = m.ss_list; };
~Measurement() { ss_list.clear(); };
vector<int> getSsList()const { return ss_list; };
float getAverage()const { return average_ss; };
string getMacAddr()const { return mac_addr; };
void addSsValue(int ssv);
void setMacAddr(string ma) { mac_addr = ma; };
float getSsSquareDistance(float ss)const;
friend ostream &operator<<(ostream &os, Measurement &m);
};
#endif

View File

@ -2,30 +2,30 @@
Point Point::operator=(const Point &p)
{
if(this == &p)
return *this;
x = p.x;
y = p.y;
z = p.z;
return *this;
if(this == &p)
return *this;
x = p.x;
y = p.y;
z = p.z;
return *this;
}
bool Point::operator==(const Point &p)const
{
if((x == p.x)&&(y == p.y)&&(z == p.z))
return true;
return false;
if((x == p.x) && (y == p.y) && (z == p.z))
return true;
return false;
}
bool Point::operator!=(const Point &p)const
{
if((x == p.x)&&(y == p.y)&&(z == p.z))
return false;
return true;
if((x == p.x) && (y == p.y) && (z == p.z))
return false;
return true;
}
ostream &operator<<(ostream &os, const Point &p)
{
os << "(" << p.x << ";" << p.y << ";" << p.z << ")";
return os;
os << "(" << p.x << ";" << p.y << ";" << p.z << ")";
return os;
}

View File

@ -8,29 +8,28 @@ using namespace std;
class Point
{
protected:
float x;
float y;
float z;
protected:
float x;
float y;
float z;
public:
Point() { x = 0; y = 0; z = 0; };
Point(const Point &p) { x = p.x; y = p.y; z = p.z; } ;
Point(float my_x, float my_y, float my_z) { x = my_x; y = my_y; z = my_z; };
~Point() {};
float getX()const { return x; };
float getY()const { return y; };
float getZ()const { return z; };
void setX(float my_x) { x = my_x; };
void setY(float my_y) { y = my_y; };
void setZ(float my_z) { z = my_z; };
float squareDistance(const Point &p)const { return ((x-p.x)*(x-p.x))+((y-p.y)*(y-p.y))+((z-p.z)*(z-p.z)); };
float squareDistance(float mx, float my, float mz)const { return ((x-mx)*(x-mx))+((y-my)*(y-my))+((z-mz)*(z-mz)); };
float distance(const Point &p)const { return sqrt(((x-p.x)*(x-p.x))+((y-p.y)*(y-p.y))+((z-p.z)*(z-p.z))); };
Point operator=(const Point &p);
bool operator==(const Point &p)const;
bool operator!=(const Point &p)const;
friend ostream &operator<<(ostream & os, const Point &p);
public:
Point(float _x = 0, float _y = 0, float _z = 0) { x = _x; y = _y; z = _z; } ;
Point(const Point &p) { x = p.x; y = p.y; z = p.z; } ;
~Point() {};
float getX()const { return x; };
float getY()const { return y; };
float getZ()const { return z; };
void setX(float my_x) { x = my_x; };
void setY(float my_y) { y = my_y; };
void setZ(float my_z) { z = my_z; };
float squareDistance(const Point &p)const { return ((x-p.x)*(x-p.x))+((y-p.y)*(y-p.y))+((z-p.z)*(z-p.z)); };
float squareDistance(float mx, float my, float mz)const { return ((x-mx)*(x-mx))+((y-my)*(y-my))+((z-mz)*(z-mz)); };
float distance(const Point &p)const { return sqrt(((x-p.x)*(x-p.x))+((y-p.y)*(y-p.y))+((z-p.z)*(z-p.z))); };
Point operator=(const Point &p);
bool operator==(const Point &p)const;
bool operator!=(const Point &p)const;
friend ostream &operator<<(ostream & os, const Point &p);
};
#endif

View File

@ -15,9 +15,8 @@ protected:
vector<Measurement> measurement_list;
public:
ReferencePoint() { coordinates.setX(0); coordinates.setY(0); coordinates.setZ(0); };
ReferencePoint(float x = 0, float y = 0, float z = 0) { coordinates.setX(x); coordinates.setY(y); coordinates.setZ(z); };
ReferencePoint(const ReferencePoint &rp) { coordinates = rp.coordinates; measurement_list = rp.measurement_list; };
ReferencePoint(float x, float y, float z) { coordinates.setX(x); coordinates.setY(y); coordinates.setZ(z); };
ReferencePoint(Point c) { coordinates = c; };
~ReferencePoint() { measurement_list.clear(); };
float getSsSquareDistance(vector<Measurement> m)const;

View File

@ -1,15 +1,16 @@
#include "server.hh"
/* Misc. very usefull functions */
/* Explodes a string into substrings based on separator sep. Returns a string vector. */
inline vector<string> explode(string input, char sep)
{
vector<string> vs;
string tmp;
unsigned int i;
for(i=0;i<input.size();i++)
if(input[i] == sep)
for (i = 0 ; i < input.size() ; i++)
if (input[i] == sep)
{
vs.push_back(tmp);
tmp.clear();
@ -18,11 +19,11 @@ inline vector<string> explode(string input, char sep)
{
tmp.push_back(input[i]);
}
//Last entry, did not encounter a separator.
vs.push_back(tmp);
tmp.clear();
return vs;
}
@ -30,9 +31,9 @@ inline vector<string> explode(string input, char sep)
inline int string2int(string nb)
{
istringstream iss(nb);
int tmp;
iss>>tmp;
iss >> tmp;
return tmp;
}
@ -40,9 +41,9 @@ inline int string2int(string nb)
inline unsigned int string2uint(string nb)
{
istringstream iss(nb);
unsigned int tmp;
iss>>tmp;
iss >> tmp;
return tmp;
}
@ -50,9 +51,9 @@ inline unsigned int string2uint(string nb)
inline float string2float(string nb)
{
istringstream iss(nb);
float tmp;
iss>>tmp;
iss >> tmp;
return tmp;
}
@ -62,13 +63,13 @@ inline vector<int> extractValues(string buff)
unsigned int ptr = 0;
vector<int> ret;
string tmp_field;
if(buff[buff.size()-1] != ';')
if (buff[buff.size()-1] != ';')
buff.push_back(';');
while(ptr < buff.size())
while (ptr < buff.size())
{
if(buff[ptr] != ';')
if (buff[ptr] != ';')
tmp_field.push_back(buff[ptr]);
else
{
@ -85,10 +86,10 @@ inline vector<string> extractReferencePointInfoFromBuffer(string buffer_in)
unsigned int i = 0;
string tmp_field;
vector<string> ret;
/* Extract coordinates */
/* x */
while(buffer_in[i] != ';')
while (buffer_in[i] != ';')
{
tmp_field.push_back(buffer_in[i]);
i++;
@ -96,9 +97,9 @@ inline vector<string> extractReferencePointInfoFromBuffer(string buffer_in)
ret.push_back(tmp_field);
tmp_field.clear();
i++; //go after the ';'
/* y */
while(buffer_in[i] != ';')
while (buffer_in[i] != ';')
{
tmp_field.push_back(buffer_in[i]);
i++;
@ -106,9 +107,9 @@ inline vector<string> extractReferencePointInfoFromBuffer(string buffer_in)
ret.push_back(tmp_field);
tmp_field.clear();
i++;
/* Extract direction (not used now) */
while(buffer_in[i] != ';')
while (buffer_in[i] != ';')
{
tmp_field.push_back(buffer_in[i]);
i++;
@ -116,9 +117,9 @@ inline vector<string> extractReferencePointInfoFromBuffer(string buffer_in)
ret.push_back(tmp_field);
tmp_field.clear();
i++;
/* Extract mac address */
while(buffer_in[i] != ';')
while (buffer_in[i] != ';')
{
tmp_field.push_back(buffer_in[i]);
i++;
@ -126,49 +127,35 @@ inline vector<string> extractReferencePointInfoFromBuffer(string buffer_in)
ret.push_back(tmp_field);
tmp_field.clear();
i++;
/* Extract scan list */
while(i < buffer_in.size())
while (i < buffer_in.size())
{
tmp_field.push_back(buffer_in[i]);
i++;
}
ret.push_back(tmp_field);
tmp_field.clear();
/* Return the vector with each data */
return ret;
}
/* ***************************************************************** */
Server::Server()
{
/* Open socket */
sockListen = socket(PF_INET, SOCK_DGRAM, 0);
sockSend = socket(PF_INET, SOCK_DGRAM, 0);
/* Set addr */
server_addr.sin_family = AF_INET;
server_addr.sin_port = htons(DEFAULT_LISTEN_PORT);
server_addr.sin_addr.s_addr = inet_addr(DEFAULT_IP);
memset(server_addr.sin_zero, '\0', sizeof(server_addr.sin_zero));
/* Bind */
bind(sockListen, (struct sockaddr *)&server_addr, sizeof(server_addr));
}
Server::Server(string ip_addr, int listen_port, int send_port)
//Server::Server(string ip_addr, int listen_port, int send_port) // FIXME : paramètre send_port inutilisé
Server::Server(string ip_addr, int listen_port)
{
/* Open socket */
sockListen = socket(PF_INET, SOCK_DGRAM, 0);
sockSend = socket(PF_INET, SOCK_DGRAM, 0);
/* Set addr */
server_addr.sin_family = AF_INET;
server_addr.sin_port = htons(listen_port);
server_addr.sin_addr.s_addr = inet_addr(ip_addr.c_str());
memset(server_addr.sin_zero, '\0', sizeof(server_addr.sin_zero));
/* Bind */
bind(sockListen, (struct sockaddr *)&server_addr, sizeof(server_addr));
}
@ -197,10 +184,11 @@ bool Server::pointExists(float x, float y, float z)const
{
Point p(x, y, z);
unsigned int i;
for(i=0;i<reference_point_list.size();i++)
if(p == reference_point_list[i].getCoordinates())
for (i = 0 ; i < reference_point_list.size() ; i++)
if (p == reference_point_list[i].getCoordinates())
return true;
return false;
}
@ -209,57 +197,57 @@ unsigned int Server::pointIndex(float x, float y, float z)const
{
Point p(x, y, z);
unsigned int i;
for(i=0;i<reference_point_list.size();i++)
if(p == reference_point_list[i].getCoordinates())
for (i = 0 ; i < reference_point_list.size() ; i++)
if (p == reference_point_list[i].getCoordinates())
return i;
/* Should never happen */
return 0;
return 0; // Should never happen
}
bool Server::pointExists(Point p)const
{
unsigned int i;
for(i=0;i<reference_point_list.size();i++)
if(p == reference_point_list[i].getCoordinates())
for (i = 0 ; i < reference_point_list.size() ; i++)
if (p == reference_point_list[i].getCoordinates())
return true;
return false;
}
bool Server::apExists(string ap_addr)const
{
unsigned int i;
for(i=0;i<access_point_list.size();i++)
if(access_point_list[i].getApAddr() == ap_addr)
for (i = 0 ; i < access_point_list.size() ; i++)
if (access_point_list[i].getApAddr() == ap_addr)
return true;
return false;
}
unsigned int Server::apIndex(string ap_addr)const
{
unsigned int i;
for(i=0;i<access_point_list.size();i++)
if(access_point_list[i].getApAddr() == ap_addr)
for (i = 0 ; i < access_point_list.size() ; i++)
if (access_point_list[i].getApAddr() == ap_addr)
return i;
/* Should never happen */
return 0;
return 0; // Should never happen
}
/* Do not forget to call pointExists() before this one */
unsigned int Server::pointIndex(Point p)const
{
unsigned int i;
for(i=0;i<reference_point_list.size();i++)
if(p == reference_point_list[i].getCoordinates())
for (i = 0 ; i < reference_point_list.size() ; i++)
if (p == reference_point_list[i].getCoordinates())
return i;
/* Should never happen */
return 0;
return 0; // Should never happen
}
/* return -1 if point does not exist, which should never happen */
@ -270,9 +258,9 @@ vector<Point> Server::getkClosestInSs(vector<Measurement> m, unsigned int k, boo
vector<Point> points_vector;
Point tmp_pt;
float tmp_distance = 0, dist_max = 10000000, tmp_min;
for(i=0;i<reference_point_list.size();i++)
if(!ignore_point||(reference_point_list[i].getCoordinates() != point_ignored))
for (i = 0 ; i < reference_point_list.size() ; i++)
if (!ignore_point||(reference_point_list[i].getCoordinates() != point_ignored))
{
tmp_distance = reference_point_list[i].getSsSquareDistance(m);
/* if not k points, add it */
@ -288,8 +276,8 @@ vector<Point> Server::getkClosestInSs(vector<Measurement> m, unsigned int k, boo
if(dist_max > tmp_distance)
{
/* remove old max */
for(j=0;j<distances_vector.size();j++)
if(distances_vector[j] == dist_max)
for (j = 0 ; j < distances_vector.size() ; j++)
if (distances_vector[j] == dist_max)
{
dist_max = tmp_distance;
distances_vector.erase(distances_vector.begin() + j);
@ -302,31 +290,32 @@ vector<Point> Server::getkClosestInSs(vector<Measurement> m, unsigned int k, boo
/* Else nothing needs to be done */
}
}
/* Sorts the vector */
for(i=0;i<distances_vector.size()-1;i++)
for (i = 0 ; i < distances_vector.size() - 1 ; i++)
{
tmp_min = distances_vector[i];
min_idx = i;
for(j=i+1;j<distances_vector.size();j++)
if(tmp_min > distances_vector[j])
for (j = i+1 ; j < distances_vector.size() ; j++)
if (tmp_min > distances_vector[j])
{
tmp_min = distances_vector[j];
min_idx = j;
}
if(min_idx != i)
if (min_idx != i)
{
/* Swap points */
tmp_pt = points_vector[i];
points_vector[i] = points_vector[min_idx];
points_vector[min_idx] = tmp_pt;
/* Swap distances */
distances_vector[min_idx] = distances_vector[i];
distances_vector[i] = tmp_min;
}
}
return points_vector;
}
@ -338,25 +327,25 @@ Point Server::getkWeightedInSs(vector<Measurement> m, unsigned int k, bool ignor
float tmp_distance = 0, dist_max = 10000000;
Point ret;
float total = 0, x = 0, y = 0, z = 0;
for(i=0;i<reference_point_list.size();i++)
if(!ignore_point||(reference_point_list[i].getCoordinates() != point_ignored))
for (i = 0 ; i < reference_point_list.size() ; i++)
if (!ignore_point || (reference_point_list[i].getCoordinates() != point_ignored))
{
tmp_distance = reference_point_list[i].getSsSquareDistance(m);
/* if not k points, add it */
if(distances_vector.size() < k)
if (distances_vector.size() < k)
{
distances_vector.push_back(tmp_distance);
points_vector.push_back(reference_point_list[i].getCoordinates());
dist_max = (dist_max > tmp_distance)?tmp_distance:dist_max;
dist_max = (dist_max > tmp_distance) ? tmp_distance : dist_max;
}
else
{
/* if tmp_dst < dist_max, should add it and remove previous greatest dist. */
if(dist_max > tmp_distance)
if (dist_max > tmp_distance)
{
/* remove old max */
for(j=0;j<distances_vector.size();j++)
for (j = 0 ; j < distances_vector.size() ; j++)
if(distances_vector[j] == dist_max)
{
dist_max = tmp_distance;
@ -370,20 +359,20 @@ Point Server::getkWeightedInSs(vector<Measurement> m, unsigned int k, bool ignor
/* Else nothing needs to be done */
}
}
for(i=0;i<distances_vector.size();i++)
for (i = 0 ; i < distances_vector.size() ; i++)
total += distances_vector[i];
for(i=0;i<distances_vector.size();i++)
for (i = 0 ; i < distances_vector.size() ; i++)
{
x += points_vector[i].getX() * distances_vector[i] / total;
y += points_vector[i].getY() * distances_vector[i] / total;
z += points_vector[i].getZ() * distances_vector[i] / total;
}
ret.setX(x);
ret.setY(y);
ret.setZ(z);
return ret;
}
@ -392,8 +381,8 @@ Point Server::kPointsAverage(vector<Point> vp)const
unsigned int i;
float x=0, y=0, z=0;
Point p;
for(i=0;i<vp.size();i++)
for (i = 0 ; i < vp.size() ; i++)
{
x += vp[i].getX();
y += vp[i].getY();
@ -402,7 +391,7 @@ Point Server::kPointsAverage(vector<Point> vp)const
p.setX(x / (float) vp.size());
p.setY(y / (float) vp.size());
p.setZ(z / (float) vp.size());
return p;
}
@ -415,47 +404,47 @@ Point Server::fbcm(vector<Measurement> m, int client_idx)const
unsigned int i, ap_idx;
float constant_term, minmax_res, minmax_max;
float x = MINMAX_X_START, y = MINMAX_Y_START;
i = 0;
//cout << "FBCM: ";
for(i=0;i<m.size();i++)
if(apExists(m[i].getMacAddr()))
for (i = 0 ; i < m.size() ; i++)
if (apExists(m[i].getMacAddr()))
{
ap_idx = apIndex(m[i].getMacAddr());
//cout << "AP idx: " << ap_idx << " ";
centres.push_back(access_point_list[ap_idx].getCoordinates());
addr.push_back(m[i].getMacAddr());
constant_term = access_point_list[ap_idx].getOutputPower() + access_point_list[ap_idx].getAntennaGain() + 2;
constant_term += 20 * log10((300000000.0/(float) access_point_list[ap_idx].getFrequency())/(4*M_PI));
constant_term += 20 * log10((300000000.0 / (float) access_point_list[ap_idx].getFrequency()) / (4*M_PI));
//end of expr. should be: client_list[client_idx].getAntennaGain() instead of 2.
//cout << "20log(" << (300000000.0/(float) access_point_list[ap_idx].getFrequency())/(4*M_PI) << ") = ";
//cout << "20log(" << (300000000.0 / (float) access_point_list[ap_idx].getFrequency()) / (4*M_PI) << ") = ";
//cout << constant_term << " ";
dist_vect.push_back(pow(10, (constant_term - m[i].getAverage()) / (10 * access_point_list[ap_idx].getFriisIndex())));
//cout << endl;
}
/* Then: min-max */
minmax_res = 1000000;
for(x=MINMAX_X_START;x<MINMAX_X_STOP;x+=MINMAX_STEP)
for(y=MINMAX_Y_START;y<MINMAX_Y_STOP;y+=MINMAX_STEP)
for (x = MINMAX_X_START ; x < MINMAX_X_STOP ; x += MINMAX_STEP)
for (y = MINMAX_Y_START ; y < MINMAX_Y_STOP ; y += MINMAX_STEP)
{
minmax_max = 0;
for(i=0;i<centres.size();i++)
if((centres[i].squareDistance(x, y, 3) - (dist_vect[i]*dist_vect[i])) > minmax_max)
minmax_max = centres[i].squareDistance(x, y, 3) - (dist_vect[i]*dist_vect[i]);
if(minmax_max < minmax_res)
for (i = 0 ; i < centres.size() ; i++)
if ((centres[i].squareDistance(x, y, 3) - (dist_vect[i]*dist_vect[i])) > minmax_max)
minmax_max = centres[i].squareDistance(x, y, 3) - (dist_vect[i] * dist_vect[i]);
if (minmax_max < minmax_res)
{
ret.setX(x);
ret.setY(y);
minmax_res = minmax_max;
}
}
/* Clear all vectors */
addr.clear();
dist_vect.clear();
centres.clear();
/* Return position */
return ret;
}
@ -469,42 +458,42 @@ Point Server::interlink(vector<Measurement> m, int client_idx)const
unsigned int i, ap_idx;
float constant_term, minmax_res, minmax_max;
float x = MINMAX_X_START, y = MINMAX_Y_START;
i = 0;
for(i=0;i<m.size();i++)
if(apExists(m[i].getMacAddr()))
for (i = 0 ; i < m.size() ; i++)
if (apExists(m[i].getMacAddr()))
{
ap_idx = apIndex(m[i].getMacAddr());
centres.push_back(access_point_list[ap_idx].getCoordinates());
addr.push_back(m[i].getMacAddr());
constant_term = access_point_list[ap_idx].getOutputPower() + access_point_list[ap_idx].getAntennaGain();
constant_term += 20 * log10((300000000.0/(float) access_point_list[ap_idx].getFrequency())/(4*M_PI)) + 2;
constant_term += 20 * log10((300000000.0 / (float) access_point_list[ap_idx].getFrequency()) / (4*M_PI)) + 2;
//end of expr. should be: client_list[client_idx].getAntennaGain() instead of 2.
dist_vect.push_back(pow(10, (constant_term - m[i].getAverage()) / 35));
}
}
/* Then: min-max */
minmax_res = 1000000;
for(x=MINMAX_X_START;x<MINMAX_X_STOP;x+=MINMAX_STEP)
for(y=MINMAX_Y_START;y<MINMAX_Y_STOP;y+=MINMAX_STEP)
for (x = MINMAX_X_START ; x < MINMAX_X_STOP ; x += MINMAX_STEP)
for (y = MINMAX_Y_START ; y < MINMAX_Y_STOP ; y += MINMAX_STEP)
{
minmax_max = 0;
for(i=0;i<centres.size();i++)
if((centres[i].squareDistance(x, y, 3) - (dist_vect[i]*dist_vect[i])) > minmax_max)
minmax_max = centres[i].squareDistance(x, y, 3) - (dist_vect[i]*dist_vect[i]);
if(minmax_max < minmax_res)
for (i = 0 ; i < centres.size() ; i++)
if ((centres[i].squareDistance(x, y, 3) - (dist_vect[i] * dist_vect[i])) > minmax_max)
minmax_max = centres[i].squareDistance(x, y, 3) - (dist_vect[i] * dist_vect[i]) ;
if (minmax_max < minmax_res)
{
ret.setX(x);
ret.setY(y);
minmax_res = minmax_max;
}
}
/* Clear all vectors */
addr.clear();
dist_vect.clear();
centres.clear();
/* Return position */
return ret;
}
@ -521,12 +510,18 @@ void Server::makeReferencePointListFromFile(string filename)
string cpp_buffer, tmp_mes;
vector<int> measures_vector;
vector<string> infos;
input_file.open(filename.c_str());
while(!input_file.eof())
input_file.open(filename.c_str()) ;
if (input_file.fail())
{
cerr << "Error opening input file « " << filename << " » !" << endl ;
return ;
}
while (!input_file.eof())
{
input_file.getline(buffer, BUFFER_LENGTH);
if ((input_file.rdstate() & ifstream::eofbit ) == 0 )
if ((input_file.rdstate() & ifstream::eofbit) == 0)
{
/* Extract fields */
cpp_buffer = buffer;
@ -538,18 +533,18 @@ void Server::makeReferencePointListFromFile(string filename)
tmp_point.setY(y);
tmp_point.setZ(DEFAULT_Z);
/* Use C++ string format */
if(!pointExists(tmp_point))
if (!pointExists(tmp_point))
{
rp.setCoordinates(tmp_point);
reference_point_list.push_back(rp);
}
pt_idx = pointIndex(tmp_point);
measures_vector = extractValues(infos[4]);
for(i=0;i<measures_vector.size();i++)
for (i = 0 ; i < measures_vector.size() ; i++)
reference_point_list[pt_idx].addMeasurement(infos[3], measures_vector[i]);
}
}
input_file.close();
measures_vector.clear();
}
@ -560,16 +555,22 @@ void Server::makeApListFromFile(string filename)
char buffer[BUFFER_LENGTH];
vector<string> ap_infos;
AccessPoint tmp_ap;
input_file.open(filename.c_str());
while(!input_file.eof())
if (input_file.fail())
{
cerr << "Error opening input file « " << filename << " » !" << endl ;
return ;
}
while (!input_file.eof())
{
input_file.getline(buffer, BUFFER_LENGTH);
if ((input_file.rdstate() & ifstream::eofbit ) == 0 )
if ((input_file.rdstate() & ifstream::eofbit) == 0)
{
ap_infos = explode(buffer, ';');
cout << buffer << endl;
for(unsigned int i=0;i<ap_infos.size();i++)
for (unsigned int i=0 ; i < ap_infos.size() ; i++)
cout << ap_infos[i] << endl;
tmp_ap.setApAddr(ap_infos[0]);
tmp_ap.setCoordinates(string2float(ap_infos[1]), string2float(ap_infos[2]), string2float(ap_infos[3]));
@ -580,23 +581,23 @@ void Server::makeApListFromFile(string filename)
ap_infos.clear();
}
}
input_file.close();
}
void Server::printReferencePointList()
{
unsigned int i;
for(i=0;i<reference_point_list.size();i++)
for (i = 0 ; i < reference_point_list.size() ; i++)
cout << reference_point_list[i] << endl;
}
void Server::printAccessPointList()
{
unsigned int i;
for(i=0;i<access_point_list.size();i++)
for (i = 0 ; i < access_point_list.size() ; i++)
cout << access_point_list[i] << endl;
}
@ -608,8 +609,8 @@ void Server::computeFriisFromRefList()
float ap_power, ap_gain, calib_gain = 2, const_term, mes_power, friis_sum;
unsigned int ap_freq;
string ap_mac;
for(i=0;i<access_point_list.size();i++)
for (i = 0 ; i < access_point_list.size() ; i++)
{
ap_power = access_point_list[i].getOutputPower();
ap_coords = access_point_list[i].getCoordinates();
@ -623,17 +624,15 @@ void Server::computeFriisFromRefList()
const_term += 20 * log10 (300000000.0 / ap_freq) + ap_power;
/* Compute an index for each ref point. List stored in friis_idx_list */
for(j=0;j<reference_point_list.size();j++)
for (j = 0 ; j < reference_point_list.size() ; j++)
{
pt_coords = reference_point_list[j].getCoordinates();
if(reference_point_list[i].getPowerForAp(ap_mac, &mes_power))
{
friis_idx_list.push_back((const_term - mes_power) / (10 * log10(ap_coords.distance(pt_coords))));
}
if (reference_point_list[i].getPowerForAp(ap_mac, &mes_power))
friis_idx_list.push_back((const_term - mes_power) / (10 * log10(ap_coords.distance(pt_coords))));
}
/* Now, compute avg value */
friis_sum = 0;
for(j=0;j<friis_idx_list.size();j++)
for (j = 0 ; j < friis_idx_list.size() ; j++)
friis_sum += friis_idx_list[j];
access_point_list[i].setFriisIndex(friis_sum / friis_idx_list.size());
cout << access_point_list[i].getApAddr() << " -> " << (friis_sum / friis_idx_list.size()) << endl;
@ -641,45 +640,49 @@ void Server::computeFriisFromRefList()
}
}
/*
* Function computes new cumulative distances for each running viterbi instance,
* Returns the solution (type: Point) of the last ended viterbi.
* Distances are grouped by line corresponding to an instance.
* vk MUST be the same as last.size() and current.size() !
*/
/*
Point Server::viterbiLike(float ** dists, unsigned short vk, unsigned short vn, vector<Point> last, vector<Point> current)
{
unsigned int i, j, k;
float min;
vector<float> last_dists;
Point position;
/* Compute the ending viterbi: line 0 */
for(i=0;i<current.size();i++)
// Compute the ending viterbi: line 0
for (i = 0 ; i < current.size() ; i++)
{
min = dists[0][0] + last[0].distance(current[i]);
for(j=1;j<last.size();j++)
if((dists[0][j] + last[j].distance(current[i])) < min)
for (j = 1 ; j < last.size() ; j++)
if ((dists[0][j] + last[j].distance(current[i])) < min)
min = dists[0][j] + last[j].distance(current[i]);
last_dists.push_back(min);
}
/* Find shortest dist */
// Find shortest dist
min = last_dists[0];
j = 0;
for(i=1;i<last_dists.size();i++)
if(last_dists[i] < min)
for (i = 1 ; i < last_dists.size() ; i++)
if (last_dists[i] < min)
{
min = last_dists[i];
j = i;
}
/* Shortest distance determines the true point */
// Shortest distance determines the true point
position = current[j];
/* Now, compute the remaining of the distance matrix */
// Now, compute the remaining of the distance matrix
}
*/
/* For experimentation purpose only */
void Server::radar_exp()
@ -690,17 +693,23 @@ void Server::radar_exp()
unsigned int i;
vector<Measurement> vm;
makeReferencePointListFromFile("complete-scan.csv");
makeApListFromFile("accesspoints.cfg");
makeReferencePointListFromFile(DEFAULT_REF_POINT_FILE);
makeApListFromFile(DEFAULT_AP_FILE);
computeFriisFromRefList();
/* Open a log file */
logfile.open("radar_exp.csv");
logfile.open(DEFAULT_LOGFILE);
if (logfile.fail())
{
cerr << "Error opening output file « " << logfile << " » !" << endl ;
return ;
}
/* Column names */
logfile << "Coordinates\t2-kss\t(Error)\t3-kss\t(Error)\t4-kss\t(Error)\t5-kss\t(Error)\tnss\t(Error)\tInterlink\t(Error)\tFBCM\t(Error)" << endl;
for(i=0;i<reference_point_list.size();i++)
cout << reference_point_list.size() << " reference points." << endl ;
for (i = 0 ; i < reference_point_list.size() ; i++)
{
/* Get point measurements */
vm.clear();
@ -719,7 +728,7 @@ void Server::radar_exp()
logfile << solution << "\t" << solution.distance(ref_coords) << "\t";
solution = getkWeightedInSs(vm, 5, true, ref_coords);
logfile << solution << "\t" << solution.distance(ref_coords) << "\t";
/* Nearest in SS */
solutions = getkClosestInSs(vm, 1, true, ref_coords);
logfile << solutions[0] << "\t" << solutions[0].distance(ref_coords) << "\t";

View File

@ -22,6 +22,9 @@
using namespace std;
using std::string;
#define DEFAULT_LOGFILE "log/radar_exp.csv"
#define DEFAULT_REF_POINT_FILE "csv/complete-scan.csv"
#define DEFAULT_AP_FILE "cfg/accesspoints.cfg"
#define DEFAULT_IP "127.0.0.1"
#define DEFAULT_LISTEN_PORT 7777
#define LIGHT_SPEED 300000000
@ -43,10 +46,10 @@ protected:
struct sockaddr_in server_addr;
int sockListen;
int sockSend;
public:
Server();
Server(string ip_addr, int listen_port, int send_port);
//Server(string ip_addr = DEFAULT_IP, int listen_port = DEFAULT_LISTEN_PORT, int send_port);
Server(string ip_addr = DEFAULT_IP, int listen_port = DEFAULT_LISTEN_PORT);
~Server();
void send_to_client(int cl);
int receive_data();
@ -69,6 +72,8 @@ public:
unsigned int getNbReferencePoints()const { return reference_point_list.size(); };
/* For experimentation purpose only ! */
void radar_exp();
/* For compilation purpose :-) */
// Point viterbiLike(float**, short unsigned int, short unsigned int, std::vector<Point, std::allocator<Point> >, std::vector<Point, std::allocator<Point> >) ;
};
#endif

View File

@ -18,8 +18,8 @@ int main(int argc, char ** argv)
ofstream output_file;
string read_file;
Server my_server;
my_server.radar_exp();
return 0;
}