This repository has been archived on 2020-04-08. You can view files and clone it, but cannot push or open issues or pull requests.
Files
YASMIN/ui/map/2D/Floor2D.h
mail@toni-fetzer.de 20ae2f5c2a started to add ble functions
added ble as sensor to java and c++
added sensorlistener for ble
added ble to observation and onDataSensor in filter
started to work on ble fingerprints for optimization
2019-06-05 18:04:31 +02:00

176 lines
5.1 KiB
C++

#ifndef FLOOR2D_H
#define FLOOR2D_H
#include <Indoor/floorplan/v2/Floorplan.h>
#include "Renderable2D.h"
#include <QLinearGradient>
/**
* draw the floor itself (outline, obstacles)
*/
class Floor2D : public Renderable2D {
private:
Floorplan::Floor* floor;
public:
/** ctor */
Floor2D(Floorplan::Floor* floor) : floor(floor) {
}
protected:
void doRender(QPainter& qp, const Scaler2D& s, const RenderParams2D& r) override {
if (floor->atHeight < r.clip.belowHeight_m) {return;}
if (floor->atHeight > r.clip.aboveHeight_m) {return;}
for (const Floorplan::FloorObstacle* obs : floor->obstacles) {
const Floorplan::FloorObstacleWall* line = dynamic_cast<const Floorplan::FloorObstacleWall*>(obs);
if (line) {drawObstacle(qp, s, line);}
}
for (const Floorplan::FloorOutlinePolygon* poly : floor->outline) {
drawOutline(qp, s, poly);
}
for (const Floorplan::Stair* stair : floor->stairs) {
const Floorplan::StairFreeform* sf = dynamic_cast<const Floorplan::StairFreeform*>(stair);
if (sf) {drawStair(qp, s, sf);}
}
for (const Floorplan::Elevator* elevator : floor->elevators) {
drawElevator(qp, s, elevator);
}
}
private:
static inline QPen getPen(Floorplan::Material mat, Floorplan::ObstacleType type, int thickness) {
using namespace Floorplan;
QPen pen; pen.setColor(Qt::darkGray);
if (mat == Material::CONCRETE) {pen.setWidth(thickness);}
if (mat == Material::DRYWALL) {pen.setWidth(thickness); pen.setColor(Qt::gray);}
if (mat == Material::GLASS) {pen.setStyle(Qt::PenStyle::DotLine);}
if (type == ObstacleType::HANDRAIL) {pen.setStyle(Qt::PenStyle::DashLine);}
if (type == ObstacleType::UNKNOWN) {pen.setColor(Qt::red); pen.setWidth(5);}
if (type == ObstacleType::PILLAR) {pen.setColor(Qt::red); pen.setWidth(5);}
return pen;
}
void drawObstacle(QPainter& qp, const Scaler2D& s, const Floorplan::FloorObstacleWall* line) {
const Point2 pt1 = s.mapToScreen(line->from);
const Point2 pt2 = s.mapToScreen(line->to);
qp.setPen(getPen(line->material, line->type, static_cast<int>(s.mToPX(line->thickness_m))));
qp.drawLine(pt1.x, pt1.y, pt2.x, pt2.y);
}
void drawElevator(QPainter& qp, const Scaler2D& s, const Floorplan::Elevator* elevator) {
const QPolygon qpoly = toQPolygon(elevator->getPoints(), s);
qp.setBrush(Qt::gray);
qp.setPen(Qt::black);
qp.drawPolygon(qpoly);
}
void drawStair(QPainter& qp, const Scaler2D& s, const Floorplan::StairFreeform* stair) {
std::vector<Floorplan::StairPart> parts = stair->getParts();
std::vector<Floorplan::Quad3> quads = Floorplan::getQuads(parts, floor);
for (int i = 0; i < (int) parts.size(); ++i) {
const Floorplan::StairPart& part = parts[i];
const Floorplan::Quad3& quad = quads[i];
const Point2 start = s.mapToScreen(part.start.xy());
const Point2 end = s.mapToScreen(part.end.xy());
// fill the polygon with a gradient corresponding with the stair's height relative to the floor's height
QLinearGradient gradient(start.x, start.y, end.x, end.y);
const float p1 = 0.1 + clamp01( part.start.z / floor->height) * 0.8;
const float p2 = 0.1 + clamp01( part.end.z / floor->height) * 0.8;
gradient.setColorAt(0, QColor(p1*255, p1*255, p1*255));
gradient.setColorAt(1, QColor(p2*255, p2*255, p2*255));
qp.setBrush(gradient);
qp.setPen(QColor(0,0,0,128));
// polygon-construction
QPolygon poly;
poly.push_back(toQPoint(s.mapToScreen(quad.p1.xy())));
poly.push_back(toQPoint(s.mapToScreen(quad.p2.xy())));
poly.push_back(toQPoint(s.mapToScreen(quad.p3.xy())));
poly.push_back(toQPoint(s.mapToScreen(quad.p4.xy())));
qp.drawPolygon(poly);
}
}
/** draw the given outline polygon */
void drawOutline(QPainter& qp, const Scaler2D& s, const Floorplan::FloorOutlinePolygon* poly) {
// configure the drawing
if (poly->method == Floorplan::OutlineMethod::ADD) {
qp.setPen(Qt::gray);
qp.setBrush(Qt::NoBrush);
} else if (poly->method == Floorplan::OutlineMethod::REMOVE) {
QBrush brush;
brush.setStyle(Qt::BrushStyle::DiagCrossPattern);
brush.setColor(QColor(0,0,0));
qp.setPen(Qt::gray);
qp.setBrush(brush);
}
// construct the polygon
const int num = poly->poly.points.size();
QPolygon qpoly;
for (int i = 0; i < num; ++i) {
qpoly.push_back(toQPoint(s.mapToScreen(poly->poly.points[(i+0)])));
}
// draw the polygon
qp.drawPolygon(qpoly);
}
/** convert floorplan polygon to QPolygon */
static inline QPolygon toQPolygon(const Floorplan::Polygon2& poly) {
QPolygon qpoly;
for (const Point2 p : poly.points) {
qpoly.push_back(QPoint(p.x, p.y));
}
return qpoly;
}
/** convert floorplan polygon to QPolygon */
static inline QPolygon toQPolygon(const Floorplan::Polygon2& poly, const Scaler2D& s) {
QPolygon qpoly;
for (const Point2 _p : poly.points) {
const Point2 p = s.mapToScreen(_p);
qpoly.push_back(QPoint(p.x, p.y));
}
return qpoly;
}
/** convert Point2 to QPoint */
static inline QPoint toQPoint(const Point2 p) {
return QPoint(p.x, p.y);
}
/** helper method. limit val to [0:1] */
static inline float clamp01(const float val) {
if (val < 0) {return 0;}
if (val > 1) {return 1;}
return val;
}
};
#endif // FLOOR2D_H