1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
|
#include "railloco.h"
#include "gfx/gl/shader.h"
#include "gfx/models/obj.h"
#include "gfx/models/texture.h"
#include <algorithm>
#include <array>
#include <cache.h>
#include <filesystem>
#include <glm/glm.hpp>
#include <iterator>
#include <lib/resource.h>
#include <location.hpp>
#include <map>
#include <maths.h>
#include <memory>
#include <random>
#include <set>
#include <utility>
#include <vector>
RailVehicleClass::RailVehicleClass(const std::string & name) :
RailVehicleClass {std::make_unique<ObjParser>(Resource::mapPath(name + ".obj")),
Texture::cachedTexture.get(Resource::mapPath(name + ".png"))}
{
}
RailVehicleClass::RailVehicleClass(std::unique_ptr<ObjParser> o, std::shared_ptr<Texture> t) : texture {std::move(t)}
{
wheelBase = bogieOffset(*o);
length = objectLength(*o);
const auto m = o->createMeshes();
bodyMesh = m.at("Body");
bogies[0] = m.at("Bogie1");
bogies[1] = m.at("Bogie2");
}
void
RailVehicleClass::render(const Shader & shader, const Location & location, const std::array<Location, 2> & bl) const
{
texture->Bind();
for (auto b = 0U; b < bogies.size(); ++b) {
shader.setModel(bl[b]);
bogies[b]->Draw();
}
shader.setModel(location);
bodyMesh->Draw();
}
float
RailVehicleClass::bogieOffset(ObjParser & o)
{
float wheelBase {0};
// offset bogie positions so they can be set directly
for (auto & object : o.objects) { // bogie object index
if (!object.first.starts_with("Bogie"))
continue;
std::set<std::pair<float, int>> vertexIds;
for (const auto & face : object.second) {
for (const auto & faceElement : face) {
vertexIds.emplace(o.vertices[faceElement.x - 1].z, faceElement.x - 1);
}
}
const auto offset = (vertexIds.begin()->first + vertexIds.rbegin()->first) / 2;
for (const auto & v : vertexIds) {
o.vertices[v.second].z -= offset;
}
wheelBase += std::abs(offset);
}
return wheelBase;
}
float
RailVehicleClass::objectLength(ObjParser & o)
{
const auto mme = std::minmax_element(o.vertices.begin(), o.vertices.end(), [](const auto & v1, const auto & v2) {
return v1.z < v2.z;
});
return mme.second->z - mme.first->z;
}
void
RailVehicle::render(const Shader & shader) const
{
rvClass->render(shader, location, bogies);
}
void
RailLoco::move(TickDuration dur)
{
static std::mt19937 gen(std::random_device {}());
linkDist += dur.count() * speed;
auto curLink {linkHist.getCurrent()};
while (linkDist > curLink.first->length) {
location = curLink.first->positionAt(curLink.first->length, curLink.second);
auto nexts {curLink.first->nexts[1 - curLink.second]};
auto last = std::remove_if(nexts.begin(), nexts.end(), [ang = location.rot.y](const Link::Next & n) {
return std::abs(normalize(n.first.lock()->ends[n.second].second - ang)) > 0.1F;
});
if (last != nexts.begin()) {
auto off = std::uniform_int_distribution<>(0, std::distance(nexts.begin(), last) - 1)(gen);
linkDist -= curLink.first->length;
curLink = linkHist.add(nexts[off].first, nexts[off].second);
}
else {
linkDist = curLink.first->length;
speed = 0;
}
}
}
Location
RailLoco::getBogiePosition(float linkDist, float dist) const
{
float b2linkDist {};
const auto b2Link = linkHist.getAt(dist - linkDist, &b2linkDist);
return b2Link.first->positionAt(b2linkDist, b2Link.second);
}
void
RailLoco::updateRailVehiclePosition(RailVehicle * w, float trailBy) const
{
const auto overhang {(w->rvClass->length - w->rvClass->wheelBase) / 2};
const auto & b1Pos = w->bogies[0] = getBogiePosition(linkDist, trailBy += overhang);
const auto & b2Pos = w->bogies[1] = getBogiePosition(linkDist, trailBy + rvClass->wheelBase);
const auto diff = glm::normalize(b2Pos.pos - b1Pos.pos);
w->location.pos = (b1Pos.pos + b2Pos.pos) / 2.F;
w->location.rot = {-vector_pitch(diff), vector_yaw(diff), 0};
}
void
RailLoco::tick(TickDuration dur)
{
move(dur);
updateRailVehiclePosition(this, 0);
updateWagons();
}
void
RailLoco::updateWagons() const
{
// Drag wagons
float trailBy {rvClass->length + 0.6F};
for (const auto & wagon : wagons) {
const auto w {wagon.lock()};
updateRailVehiclePosition(w.get(), trailBy);
trailBy += w->rvClass->length + 0.6F;
}
}
void RailWagon::tick(TickDuration) { }
Brush47::Brush47(const LinkPtr & l) : RailLoco(std::make_shared<RailVehicleClass>("brush47"), l, 0)
{
speed = 33.6F;
linkDist = rvClass->wheelBase;
}
Brush47Wagon::Brush47Wagon(const LinkPtr & l) : RailWagon(std::make_shared<RailVehicleClass>("brush47"), l, 0)
{
linkDist = rvClass->wheelBase;
}
|
