Implemented the features described in the "Basic intensity features" section.

I tested them but I didn't add the automated tests to the test folder yet.
It is not allowed to define a non-inline and non-template function in a header. I suggest to change the function into a template on the coordinate type.