More work to PSO
Technically the movement and velocity are done now. It needs to be tested.
We also need to implement any of the three methods or so he discussed to bound velocity.
I'm hoping to comment all changes tomorrow.

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