Как-то так:

Результат oldmd и будет являться модой. data_array - массив чисел, count - размерность массива.
Честно, нашёл в своём старом проекте, который писал на C и наскоряк переписал на Pascal. Работоспособность не проверял, но всё должно быть корректно.