public void DoRun(Chromosome DNA, int RunLength)
{
ResetState();
var runStart = DateTime.Now.Ticks;
while (DateTime.Now.Ticks - runStart < RunLength)
{
var actions = DNA.Enumerate(State).ToList();
Trace.Write("Emu got " + actions.Count() + " actions for this tick. Applying...");
foreach (var action in actions.OfType <Action>())
{
//write action's angles to state
foreach (var kv in action.Angles)
{
State[kv.Key] = kv.Value;
}
//upload the new state to the device
UpdateState(State);
//wait for the actions to complete
var start = DateTime.Now.Ticks;
while (!ReadState().SequenceEqual(State) && DateTime.Now.Ticks - start < ActionCompletionTimeout)
{
;
}
}
Trace.WriteLine(" done");
}
}
/// <summary>
/// Creates and returns a mutated version of this chromosome
/// </summary>
/// <param name="MutatePercentChance">The percentage chance that any given node in the chromosome will be modified</param>
/// <returns></returns>
public Chromosome Mutate(int MutatePercentChance)
{
var c = new Chromosome(Genome.Clone() as Node);
var nodes = c.Enumerate().ToList();
Trace.Write("Mutating: ");
foreach (var n in nodes)
{
if (Random.Next(100) < MutatePercentChance)
{
//can add a child
if (Random.Next(100) < MutateChanceAdd && nodes.Count < MutateMaxSize)
{
Trace.Write(" add ");
n.AddChild(CreateNode());
}
//can lose a child
if ((Random.Next(100) < MutateChanceLose && nodes.Count > MutateMinSize) || nodes.Count > MutateMaxSize)
{
Trace.Write(" rem ");
if (n.Children.Count > 0)
{
n.RemoveChild(n.Children[Random.Next(n.Children.Count)]);
}
}
//can change an action (this is like add and lose) or a functor
if (Random.Next(100) < MutateChanceMutate)
{
Trace.Write(" mut ");
var a = n as Action;
if (a != null)
{
Mutate(a);
}
else
{
var co = n as Conditional;
if (co != null)
{
Mutate(co);
}
}
//n.GetType().GetMethod("Mutate").Invoke(n, null);
}
}
}
Trace.WriteLine("");
return(c);
}
protected int JudgeFitness(Chromosome g)
{
//run simulation
var robot = new Robot();
robot.DoRun(g, RunLength);
//judge score
var gyro = robot.GetGyroState();
var tilt = Math.Abs(gyro[0]) + Math.Abs(gyro[1]);
if (tilt < 1) //floor tilt at 1 so there arn't DbZ issues
{
tilt = 1;
}
//we're trying to judge closeness to 0 for the x and y but height for z also encourage smalller programs
var score = (100 / tilt) * gyro[2] / g.Enumerate().Count();
Trace.WriteLine(String.Format("Run ended, judging fitness for " + g + " Gyro state: {0}, {1}, {2}. Score: {3}", gyro[0], gyro[1], gyro[2], score));
return(score);
}
public void DoRun(Chromosome DNA, int RunLength)
{
ResetState();
var runStart = DateTime.Now.Ticks;
while ( DateTime.Now.Ticks - runStart < RunLength)
{
var actions = DNA.Enumerate(State).ToList();
Trace.Write("Emu got "+actions.Count()+" actions for this tick. Applying...");
foreach (var action in actions.OfType<Action>())
{
//write action's angles to state
foreach (var kv in action.Angles)
State[kv.Key] = kv.Value;
//upload the new state to the device
UpdateState(State);
//wait for the actions to complete
var start = DateTime.Now.Ticks;
while (!ReadState().SequenceEqual(State) && DateTime.Now.Ticks- start < ActionCompletionTimeout) ;
}
Trace.WriteLine(" done");
}
}
protected int JudgeFitness(Chromosome g)
{
//run simulation
var robot = new Robot();
robot.DoRun(g, RunLength);
//judge score
var gyro = robot.GetGyroState();
var tilt = Math.Abs(gyro[0]) + Math.Abs(gyro[1]);
if (tilt < 1) //floor tilt at 1 so there arn't DbZ issues
tilt = 1;
//we're trying to judge closeness to 0 for the x and y but height for z also encourage smalller programs
var score = (100 / tilt) * gyro[2] / g.Enumerate().Count();
Trace.WriteLine(String.Format("Run ended, judging fitness for " + g + " Gyro state: {0}, {1}, {2}. Score: {3}", gyro[0], gyro[1], gyro[2], score));
return score;
}
/// <summary>
/// Creates and returns a mutated version of this chromosome
/// </summary>
/// <param name="MutatePercentChance">The percentage chance that any given node in the chromosome will be modified</param>
/// <returns></returns>
public Chromosome Mutate(int MutatePercentChance)
{
var c = new Chromosome(Genome.Clone() as Node);
var nodes = c.Enumerate().ToList();
Trace.Write("Mutating: ");
foreach (var n in nodes)
{
if (Random.Next(100) < MutatePercentChance)
{
//can add a child
if (Random.Next(100) < MutateChanceAdd && nodes.Count < MutateMaxSize)
{
Trace.Write(" add ");
n.AddChild(CreateNode());
}
//can lose a child
if ((Random.Next(100) < MutateChanceLose && nodes.Count > MutateMinSize) || nodes.Count > MutateMaxSize)
{
Trace.Write(" rem ");
if (n.Children.Count > 0)
n.RemoveChild(n.Children[Random.Next(n.Children.Count)]);
}
//can change an action (this is like add and lose) or a functor
if (Random.Next(100) < MutateChanceMutate)
{
Trace.Write(" mut ");
var a = n as Action;
if (a != null)
Mutate(a);
else
{
var co = n as Conditional;
if (co != null)
Mutate(co);
}
//n.GetType().GetMethod("Mutate").Invoke(n, null);
}
}
}
Trace.WriteLine("");
return c;
}