Basic tuning of parameters

There are some obsolete prints that didn't work out the way I wanted (fixing them on todo list) but tuning works pretty well now. Code is also a bit messy some places.