CMD interface in and out is finished
Completed CMD part of controller, but not tested it
Trying to package the IP properly and test it in a MB system