вставка элемента в 2-3 дерево

Помогите, плиз. Наверное я отморозил свой моск в честь первого снега.
Суть: есть алгоритм, описывающий сабж, я его понимаю, но
реализовать - не могу! Сижу и туплю уже добрый час. Вот алгоритм:

// в дереве одна вершина - не интересно и не существенно

в дереве больше одной вершины
1)осуществляем поиск отца f для доб. знач. a
2)формируем новый лист и полагаем его значение равным а
3)определяем позицию листа по отн. к остальным сыновьям
4) если у f было два сына, то устанавливаем метки заново (с добавленным) - конец добавления
5)если у f было 3 сына
а) (для определённости порядок сыновей с1, с, с2, с3, где сi - старые, а с - новый) образуем новую вершину v, в которую помещаем двух макс. сыновей, а в f оставляем двух минимальных
б)если у f нет отца - не интересно
в)зато интересно, если у f был отец. тогда в сыновей отца f сразу за f вставляем v, и переходим к шагу 4 алгоритма

Вот и весь алгоритм. Если кто-нибудь знает, как это реализовать - обьясните плиз