swarm_state_analysis - add average current position
run_model - add some results from optimization, partial implementation of 3d visualization