Some bug fixes, added code so image is rotated by 180 deg (camera mounted other way round now)