More FM methods added

The main.cpp is used as a demo of all the capabilities of our code. Please, merge your main with the previous main.