asteroids-genetic/src/population.rs

use macroquad::{prelude::*, rand::gen_range};

use crate::{
    nn::{ActivationFunc, NN},
    world::World,
    HEIGHT, WIDTH,
};

#[derive(Clone, Copy, PartialEq)]
pub enum AutoSwitch {
    Best,
    BestAlive,
}

#[derive(Default)]
pub struct Population {
    size: usize,
    pub gen: i32,
    pub focus: bool,
    pub debug: bool,
    pub worlds: Vec<World>,
    pub track: usize,
    pub hlayers: Vec<usize>,
    pub auto_switch: Option<AutoSwitch>,
}

impl Population {
    pub fn new(
        size: usize,
        auto_switch: Option<AutoSwitch>,
        hlayers: Vec<usize>,
        mut_rate: f32,
        activ: ActivationFunc,
    ) -> Self {
        let mut s = Self {
            size,
            hlayers: hlayers.clone(),
            worlds: (0..size)
                .map(|_| World::new(Some(hlayers.clone()), Some(mut_rate), Some(activ)))
                .collect(),
            auto_switch,
            focus: true,
            ..Default::default()
        };
        s.worlds[0].track(true);
        s
    }

    pub fn update(&mut self) {
        let mut alive = false;
        for world in &mut self.worlds {
            if !world.over {
                alive = true;
                world.update();
            }
        }
        if self.worlds[self.track].over {
            if let Some(auto_switch) = self.auto_switch {
                match auto_switch {
                    AutoSwitch::Best => self.track_best(true),
                    AutoSwitch::BestAlive => self.track_best(false),
                }
            }
        }
        if !alive {
            self.gen += 1;
            self.next_gen();
        }
    }

    pub fn change_track(&mut self, pos: Vec2) {
        for i in 0..self.worlds.len() {
            if !self.worlds[i].over
                && !self.worlds[i].track
                && (self.worlds[i].player.pos - pos).length_squared() < 256.
            {
                self.worlds[self.track].track(false);
                self.worlds[i].track(true);
                self.track = i;
                break;
            }
        }
    }
    pub fn track_best(&mut self, can_be_dead: bool) {
        self.worlds[self.track].track(false);
        let i = self
            .worlds
            .iter()
            .enumerate()
            .filter(|(_, w)| !w.over || can_be_dead)
            .max_by(|(_, a), (_, b)| a.fitness.total_cmp(&b.fitness))
            .map(|(i, _)| i);
        if let Some(i) = i {
            self.worlds[i].track(true);
            self.track = i;
        }
    }
    pub fn track_prev_best(&mut self) {
        self.worlds[self.track].track(false);
        self.worlds[0].track(true);
        self.track = 0;
    }

    pub fn change_mut(&mut self, mut_rate: f32) {
        for world in &mut self.worlds {
            world.player.brain.as_mut().unwrap().mut_rate = mut_rate;
        }
    }

    pub fn change_activ(&mut self, activ: ActivationFunc) {
        for world in &mut self.worlds {
            world.player.brain.as_mut().unwrap().activ_func = activ;
        }
    }

    pub fn draw(&self) {
        for world in self.worlds.iter().rev() {
            if self.focus {
                if world.track {
                    world.draw(self.debug);
                }
            } else if !world.over {
                world.draw(self.debug);
            }
        }
        self.draw_borders();
    }

    pub fn draw_borders(&self) {
        let th = (screen_height() - HEIGHT) * 0.5;
        draw_rectangle(-WIDTH * 0.5, -screen_height() * 0.5, WIDTH, th, BLACK);
        draw_rectangle(-WIDTH * 0.5, screen_height() * 0.5 - th, WIDTH, th, BLACK);
        draw_rectangle(
            -WIDTH * 0.5 - th,
            -screen_height() * 0.5,
            th,
            screen_height(),
            BLACK,
        );
        draw_rectangle(
            WIDTH * 0.5,
            -screen_height() * 0.5,
            screen_width() - WIDTH,
            screen_height(),
            BLACK,
        );
    }

    pub fn next_gen(&mut self) {
        let total = self.worlds.iter().fold(0., |acc, x| acc + x.fitness);
        self.worlds
            .sort_by(|a, b| b.fitness.partial_cmp(&a.fitness).unwrap());
        let mut scores: std::collections::VecDeque<_> =
            self.worlds.iter().map(|w| w.fitness as f32).collect();
        let mean: f32 = scores.iter().sum::<f32>() / scores.len() as f32;
        while scores.len() > 2 {
            scores.pop_front();
            scores.pop_back();
        }
        if scores.len() == 2 {
            scores.pop_front();
        }
        let median = scores[0];

        println!(
            "{} {} {} {}",
            self.worlds[0].fitness,
            mean,
            median,
            self.worlds[self.worlds.len() - 1].fitness
        );
        let mut new_worlds = (0..std::cmp::max(1, self.size / 20))
            .map(|i| World::simulate(self.worlds[i].see_brain().to_owned()))
            .collect::<Vec<_>>();
        while new_worlds.len() < self.size {
            let rands = (gen_range(0., total), gen_range(0., total));
            let mut sum = 0.;
            let (mut a, mut b) = (None, None);
            for world in &self.worlds {
                sum += world.fitness;
                if a.is_none() && sum >= rands.0 {
                    a = Some(world.see_brain());
                }
                if b.is_none() && sum >= rands.1 {
                    b = Some(world.see_brain());
                }
            }
            if a.is_none() {
                a = Some(self.worlds.last().unwrap().see_brain());
            }
            if b.is_none() {
                b = Some(self.worlds.last().unwrap().see_brain());
            }
            let mut new_brain = NN::crossover(a.unwrap(), b.unwrap());
            new_brain.mutate();
            new_worlds.push(World::simulate(new_brain));
        }
        self.worlds = new_worlds;
        self.worlds[0].track(true);
        self.track = 0;
    }
}