Add some code to check if two nodes are cousins

1. Updated Makefile to make the new code
2. Modified the test case
3. Acutal code for cousin relationship check