Updated gazebo camera resolutions and framerates
Created diagnostics package (#34)