ARES / Mbed 2 deprecated TestMyPathFind

Test du path finding

Dependencies:   RoboClaw mbed

Fork of TestMyPathFind by Romain Ame

map/point.h

Committer:
IceTeam
Date:
2016-04-13
Revision:
41:53d5990ff99d
Parent:
39:ca4dd3faffa8

File content as of revision 41:53d5990ff99d:

#ifndef POINT_H
#define POINT_H

typedef struct P4 points4;

class point {
public:
    point (float nx, float ny) {
        x = nx;
        y = ny;
    }
    point () { ; }

    float getX () { return x; }
    float getY () { return y; }

    float operator*(point& a) {
        return calculDistance2 (x, y, a.getX(), a.getY ());
    }
    bool operator==(point& a) {
        return (x == a.getX () && y == a.getY ());
    }
    bool operator!=(point& a) {
        return !(*this == a);
    }

protected:
    float calculDistance2(float x1, float y1, float x2, float y2) {
        return ((x1-x2)*(x1 - x2) + (y1 - y2)*(y1 - y2));
    }

    float x, y;
};

struct P4 {
    point p0;
    point p1;
    point p2;
    point p3;
};

#endif