Add helpers to header file and use in test program