Message filters Cache object implementation for python

I implemented the Cache object for the Message Filters in python, since it has been a TODO for long. Have tested it in a NAO robot capturing ar_pose messages and seems to work well. 
Please implement the "sorted insert" since it shouldn't take more then a handful of lines.