add first working version of iteration FSI scheme, not cleaned but working