diff --git a/identity.hhs b/identity.hhs
new file mode 100644
index 0000000..4ebc73d
--- /dev/null
+++ b/identity.hhs
@@ -0,0 +1,38 @@
+/**
+ * @author Mudroad White
+ * @param input - a positive integer denoting the size of the expected matrix.
+ * @returns - a Mat object representing a 2D identity matrix.
+ */
+
+function identity(input) {
+
+	*import math: is_number
+
+	// Corner cases for input
+	// Argument length should be only one
+	if ( !(arguments.length === 1) ) {
+    	throw new Error('Identity expects only one argument');
+	}
+	// Input should be a positive integer
+	if (!Number.isInteger(input) || input < 0) {
+		throw new Error('Excepted positive integer input');
+	}
+
+	// Then we return special Mat value when input is 0 or 1
+	if (input === 0) {
+		return new Mat([]);
+	}
+
+	if (input === 1) {
+		return new Mat([[1]]);
+	}
+
+	// Now we can start on creating the Id matrix
+	let result = new Mat().zeros(input, input);
+	for (let i = 0; i < input; i++){
+		result.val[i][i] = 1;
+	}	
+
+	// return as a Mat object
+	return result;
+}
\ No newline at end of file
diff --git a/identity_test.hhs b/identity_test.hhs
new file mode 100644
index 0000000..8c95102
--- /dev/null
+++ b/identity_test.hhs
@@ -0,0 +1,26 @@
+/**
+ * @author Mudroad White
+ * @param 
+ * @returns 
+ *
+ * Functions for testing the identity function.
+ */
+
+function identity_test(){
+	*import math: identity
+
+	// Corner cases
+	if (!(identity(0) === new Mat([]))){
+		throw 'identity unit test failed on identity(0)';
+	}
+
+	if (!(identity(1) === new Mat([[1]]) )){
+		throw 'identity unit test failed on identity(1)';
+	}
+
+	// Ordinary case
+	const test1 = new Mat([[1, 0], [0, 1]]);
+	if (!(identity(2)) === test1){
+		throw 'identity unit test failed on identity(2)';
+	}
+}
\ No newline at end of file