Removed remains of twostep sqr implementation
Additional plotting functions added