Added sorted insertion to add method. Added all functions present in c++ version of message_filters cache
Unit test for message filters cache