Regional Assessment of Risk Using Point Clouds

[RobynCastro]

Please fill out the following before requesting review on this PR

Description

Created a node that takes in a point cloud of the ground and outputs a regional assessment of risk. Risk is based on factors like standard deviation of Z.

Testing Done

Unit tests were done to test functionality of each function.

Functional testing was done by visualising a point cloud in Rviz and then checking the output. The point cloud was taken using the Realsense.

Resolved Issues

resolves #349

Review Checklist

(Please check every item to indicate your code complies with it (by changing [ ]->[x]). This will hopefully save both you and the reviewer(s) a lot of time!)
It is the reviewers responsibility to also make sure every item here has been covered

• Start of document comments: each .cpp and .h file should have a comment at the start of it. See files in src/sample_package for examples.
• Function comments: All function definitions (usually in the .h file) should have a javadoc style comment at the start of them. For examples, see the classes defined in src/sample_package
• Remove all commented out code
• Remove extra print statements: for example, those just used for testing
• Resolve all TODO's: All TODO (or similar) statements should either be completed or associated with a github issue
  Feel free to make additions of things that we should be checking to this file if you think there's something missing!!!!

[garethellis0]

NOTE: I skipped over all the rviz marker stuff, because I think that's part of another PR that's in process? Let me know if I'm mistaken though!

Overall looks pretty good, no major functionality comments, just some comments on comments/documentation.

[garethellis0]

Looks like there are some error(s) in the CMakeLists.txt, building and running test locally should reveal them.