Add insert and find function, have them tested simply