Added insert() and a constructor

Again, didn’t test if compiles nor if math works