Improve Readme and add some pseudo code