Create testbench_nav.c