Add decreasing inertia, maximum velocity; fix best position tracking; take parameters from literature