Adding unit tests and remaining add/subtract instructions