Add PSO
Add basic PSO methods and functions