- Fixed some bugs in motor controller (busy_count was not being reset)
- Added toplevel file for programming the FPGA
- Added test bench for toplevel.