Started stepping through code and fixing some issues that were initially overlooked.   Added linker file for the f407 to increase heap size to store maze.  Once we're ready to use hardware we can switch this file out for the f405.