Convert some mdrun utility code to C++