[FEATURE] Add various cargo tests

**Describe the solution you'd like** Add various cargo tests for testing the whole kernel.