Как добавить элемент в массив и сдвинуть индексы?

Мне нужно добавить элемент в массив, указав позицию и значение. Например, у меня есть массив

int []a = {1, 2, 3, 4, 5, 6};

после применения addPos(int 4, int 87)должно быть

int []a = {1, 2, 3, 4, 87, 5};

Я понимаю, что здесь должен быть сдвиг индексов массива, но не вижу, как это реализовать в коде.