+/GENN

genetically evolving neural networks

git clone https://git.julia.blue/+/GENN

Joseph RyanUpdate Readmea43321c

master
3.1 KiB92 linesraw
1#include "Pole.h"
2
3bool Pole::step(double f) {
4    double cosTheta = cos(angle);
5    double sinTheta = sin(angle);
6    double commonFactor = 1 / (massCart + massPole * sinTheta * sinTheta);
7    double acc = commonFactor * (f + massPole * sinTheta * (length * angleSpeed + g * cosTheta));
8    double angularAcc = (-f * cosTheta - massPole * length * angleSpeed * cosTheta * sinTheta -
9                        g * sinTheta * (massCart + massPole)) * commonFactor / length;
10    cart += speed * fps * 2;
11    speed += acc * fps * 2;
12    angle += angleSpeed * fps * 2;
13    angleSpeed += angularAcc * fps * 2;
14    return cart < 0 || cart > width || cosTheta > 0;
15}
16
17void Pole::reset() {
18    speed = 0;
19    cart = width / 2;
20    angle = pi + .1 * ((rand() % 2) * 2 - 1);
21    angleSpeed = 0;
22}
23
24void Pole::play() {
25    screen = tigrWindow(width, height, "Pole Balance", 0);
26    while (!tigrClosed(screen) && !tigrKeyDown(screen, TK_ESCAPE)) {
27        accumulator += tigrTime();
28        if (accumulator > fps) {
29            if (step((tigrKeyHeld(screen, TK_RIGHT) + -tigrKeyHeld(screen, TK_LEFT)) * maxForce)) {
30                reset();
31            }
32            accumulator -= fps;
33        }
34        tigrClear(screen, tigrRGB(50, 50, 50));
35        tigrFill(screen, cart - cartWidth / 2, height / 1.5 - cartHeight, cartWidth, cartHeight,
36                 tigrRGB(255, 255, 255));
37        tigrLine(screen, cart, height / 1.5 - cartHeight, cart + cos(angle - pi / 2) * length * 5,
38                 height / 1.5 - cartHeight - sin(angle - pi / 2) * length * 5, tigrRGB(255, 255, 255));
39        tigrUpdate(screen);
40    }
41    tigrFree(screen);
42}
43
44void Pole::evaluate(Genome &g) {
45    Network n(g);
46    int fit = 0;
47    double inputs[5];
48    double output[0];
49    inputs[0] = 1;
50    reset();
51    do {
52        inputs[1] = angle;
53        inputs[2] = angleSpeed;
54        inputs[3] = cart / width - .5;
55        inputs[4] = speed;
56        n.propagate(inputs, output);
57        fit++;
58    }while(!step(output[0]*maxForce)&&fit<10000);
59    g.fitness=fit*fps;
60}
61
62void Pole::view(Network n) {
63    screen = tigrWindow(width, height, "Pole Balance", 0);
64    double output[1];
65    int steps =0;
66    while (!tigrClosed(screen) && !tigrKeyDown(screen, TK_ESCAPE)) {
67        accumulator += tigrTime();
68        if (accumulator > fps) {
69            double inputs[5];
70            inputs[0] = 1;
71            inputs[1] = angle;
72            inputs[2] = angleSpeed;
73            inputs[3] = cart / width - .5;
74            inputs[4] = speed;
75            n.propagate(inputs, output);
76            steps++;
77            if (step(output[0] * maxForce)) {
78                reset();
79                std::cout<<steps<<std::endl;
80                steps=0;
81            }
82            accumulator -= fps;
83        }
84        tigrClear(screen, tigrRGB(50, 50, 50));
85        tigrFill(screen, cart - cartWidth / 2, height / 1.5 - cartHeight, cartWidth, cartHeight,
86                 tigrRGB(255, 255, 255));
87        tigrLine(screen, cart, height / 1.5 - cartHeight, cart + cos(angle - pi / 2) * length * 5,
88                 height / 1.5 - cartHeight - sin(angle - pi / 2) * length * 5, tigrRGB(255, 255, 255));
89        tigrUpdate(screen);
90    }
91    tigrFree(screen);
92}