Clean up C implementation
Update unit test for footprinting lengths