Added particle movement

Note that the movement is just finding a new random FOA, velocity have yet to be utilised
main function changed and obj-func added

The main function now solves an optimisation problem and make use of the objective function obj-func to determine if a particles position is better than before
Modified random-FOA function

The random-FOA function have once again been modified to work faster then before