Запись и удаления из vector

Как правильно удалять последний item из вот таких вот структур, и записывать следующий в самое начало, чтобы последующие iD повышались на 1.

#ifndef FOOTPRINTCURRENT_H
#define FOOTPRINTCURRENT_H
struct FootPrintCurrentData
{
    short iD;
    double lng;
    double lat;
    double alt;
};
#endif // FOOTPRINTCURRENT_H

main.h

std::vector<FootPrintCurrentData> footPrintCurrentData;

пытался удалить последний item, если он больше 39

for(int i = 0; i < footPrintCurrentData.size(); i++)
            {
                if(i > 39)
                {
                   footPrintCurrentData.erase(footPrintCurrentData.begin()+i, footPrintCurrentData.end());
                }
            }

при удалении, просто вылетает программа.

а вот как записывать в самое начало и смещать все на 1, т.е сортировать не пойму.