Fixed some mistakes
Simulation runs stable now but waterheight rises with big timesteps >1000