Restructure matlabdoc_parser2 and add tests tests

- tests pass
- Add documentation (kind of)