Work on PSO
It looks like it's working alright, it just shoots past the optimal solution right away.
Maybe this will start working when we implement a couple of those techniques.

Signed-off-by: loganperreault <perreault.logan@gmail.com>