Add unit tests

[jayadamsmorgan]

Some of the functionalities might not be tested thoroughly through examples, so it's a good idea to also include unit testing for the C side