Implement basic CSE algorithm

As talked about with Christian in Bonn.