Merged all my local code changes that i have not yet pushed to github. This does not include any gazebo model SDFs. Scipio Will be added here from my OSX partition since it was quicker for me to make it work there. rmc_simulation will be added to the Software_RMC repo separately.