Improve testing framework

Replaced Criterrion with CMock. Added few tests, currently not working
properly. Random test upgrades.

cmake/FindCmock.cmake

@@ -0,0 +1,17 @@
+set(CMOCK_DIR "${PROJECT_SOURCE_DIR}/third_party/cmock/")
+
+
+find_library(
+    cmock
+    NAMES cmock
+    HINTS ${CMOCK_DIR}/build/src/
+)
+
+find_library(
+    unity
+    NAMES unity
+    HINTS ${CMOCK_DIR}/build/vendor/unity/src/
+)
+
+set(cmock_INCLUDE_DIR "${CMOCK_DIR}/src/")
+set(unity_INCLUDE_DIR "${CMOCK_DIR}/vendor/unity/src/")