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