CMP functionality (almost complete, bug check)

- CMP working except for one case (xxxx.L)
- Added CMP test cases
- Still fixing test case for .B An,Dn