Added adjustable parameters. (#288)

* Non-compiling rough-draft of groundToImage and helper functions

* Add adjustable parameters

* Add adj to functions

* Update based on comments, add rest of structure needed for adjustable paramters, added computeSensorParitals

* Update based on feedback and problems from merging with dev