Fix Index issue on parameter-server.cpp + fix warnings.

13 jobs for devel in 31 minutes and 46 seconds (queued for 1 second)