internal static void SetAnnotateSettings(this MMALCameraComponent camera) { if (MMALCameraConfig.Annotate != null) { MMALLog.Logger.LogDebug("Setting annotate"); var sb = new StringBuilder(); var showShutter = 0; var showAnalogGain = 0; var showLens = 0; var showCaf = 0; var showMotion = 0; var showFrame = 0; var enableTextBackground = 0; var textSize = (byte)0; var customTextColor = 0; var customTextY = (byte)0; var customTextU = (byte)0; var customTextV = (byte)0; var customBackgroundColor = 0; var customBackgroundY = (byte)0; var customBackgroundU = (byte)0; var customBackgroundV = (byte)0; var justify = MMALCameraConfig.Annotate.Justify; var xOffset = MMALCameraConfig.Annotate.XOffset; var yOffset = MMALCameraConfig.Annotate.YOffset; if (!string.IsNullOrEmpty(MMALCameraConfig.Annotate.CustomText)) { sb.Append(MMALCameraConfig.Annotate.CustomText + " "); } if (MMALCameraConfig.Annotate.ShowTimeText) { sb.Append(DateTime.Now.ToString("HH:mm") + " "); } if (MMALCameraConfig.Annotate.ShowDateText) { sb.Append(DateTime.Now.ToString("dd/MM/yyyy") + " "); } if (MMALCameraConfig.Annotate.ShowShutterSettings) { showShutter = 1; } if (MMALCameraConfig.Annotate.ShowGainSettings) { showAnalogGain = 1; } if (MMALCameraConfig.Annotate.ShowLensSettings) { showLens = 1; } if (MMALCameraConfig.Annotate.ShowCafSettings) { showCaf = 1; } if (MMALCameraConfig.Annotate.ShowMotionSettings) { showMotion = 1; } if (MMALCameraConfig.Annotate.ShowFrameNumber) { showFrame = 1; } if (MMALCameraConfig.Annotate.AllowCustomBackgroundColour) { enableTextBackground = 1; } textSize = Convert.ToByte(MMALCameraConfig.Annotate.TextSize); if (MMALCameraConfig.Annotate.TextColour != Color.Empty) { customTextColor = 1; var yuv = MMALColor.RGBToYUVBytes(MMALCameraConfig.Annotate.TextColour); customTextY = yuv.Item1; customTextU = yuv.Item2; customTextV = yuv.Item3; } if (MMALCameraConfig.Annotate.BgColour != Color.Empty) { customBackgroundColor = 1; var yuv = MMALColor.RGBToYUVBytes(MMALCameraConfig.Annotate.BgColour); customBackgroundY = yuv.Item1; customBackgroundU = yuv.Item2; customBackgroundV = yuv.Item3; } // .NET Core has an issue with marshalling arrays "ByValArray". The array being passed MUST equal the size // specified in the "SizeConst" field or you will receive an exception. Mono does not have this restriction // and is quite happy to pass an array of a lower size if asked. In order to get around this, I am creating // an array equaling "SizeConst" and copying the contents of the annotation text into it, minus the EOL character. var text = sb.ToString() + char.MinValue; var arr = new byte[MMALParametersCamera.MMAL_CAMERA_ANNOTATE_MAX_TEXT_LEN_V3]; var bytes = Encoding.ASCII.GetBytes(text); Array.Copy(bytes, arr, bytes.Length); var strV4 = new MMAL_PARAMETER_CAMERA_ANNOTATE_V4_T( new MMAL_PARAMETER_HEADER_T(MMAL_PARAMETER_ANNOTATE, Marshal.SizeOf <MMAL_PARAMETER_CAMERA_ANNOTATE_V4_T>() + (arr.Length - 1)), 1, showShutter, showAnalogGain, showLens, showCaf, showMotion, showFrame, enableTextBackground, customBackgroundColor, customBackgroundY, customBackgroundU, customBackgroundV, 0, customTextColor, customTextY, customTextU, customTextV, textSize, arr, (int)justify, xOffset, yOffset); var ptrV4 = Marshal.AllocHGlobal(Marshal.SizeOf <MMAL_PARAMETER_CAMERA_ANNOTATE_V4_T>() + (arr.Length - 1)); Marshal.StructureToPtr(strV4, ptrV4, false); try { MMALCheck(MMALPort.mmal_port_parameter_set(camera.Control.Ptr, (MMAL_PARAMETER_HEADER_T *)ptrV4), "Unable to set annotate"); } catch { Marshal.FreeHGlobal(ptrV4); ptrV4 = IntPtr.Zero; MMALLog.Logger.LogWarning("Unable to set V4 annotation structure. Trying V3. Please update firmware to latest version."); var str = new MMAL_PARAMETER_CAMERA_ANNOTATE_V3_T( new MMAL_PARAMETER_HEADER_T(MMAL_PARAMETER_ANNOTATE, Marshal.SizeOf <MMAL_PARAMETER_CAMERA_ANNOTATE_V3_T>() + (arr.Length - 1)), 1, showShutter, showAnalogGain, showLens, showCaf, showMotion, showFrame, enableTextBackground, customBackgroundColor, customBackgroundY, customBackgroundU, customBackgroundV, 0, customTextColor, customTextY, customTextU, customTextV, textSize, arr); var ptr = Marshal.AllocHGlobal(Marshal.SizeOf <MMAL_PARAMETER_CAMERA_ANNOTATE_V3_T>() + (arr.Length - 1)); Marshal.StructureToPtr(str, ptr, false); try { MMALCheck(MMALPort.mmal_port_parameter_set(camera.Control.Ptr, (MMAL_PARAMETER_HEADER_T *)ptr), "Unable to set annotate V3."); } finally { Marshal.FreeHGlobal(ptr); } } finally { if (ptrV4 != IntPtr.Zero) { Marshal.FreeHGlobal(ptrV4); } } } }
internal static void SetAnnotateSettings(this MMALCameraComponent camera) { if (MMALCameraConfig.Annotate != null) { MMALLog.Logger.Debug("Setting annotate"); var sb = new StringBuilder(); var showShutter = 0; var showAnalogGain = 0; var showLens = 0; var showCaf = 0; var showMotion = 0; var showFrame = 0; var enableTextBackground = 0; var textSize = (byte)0; var customTextColor = 0; var customTextY = (byte)0; var customTextU = (byte)0; var customTextV = (byte)0; var customBackgroundColor = 0; var customBackgroundY = (byte)0; var customBackgroundU = (byte)0; var customBackgroundV = (byte)0; var justify = MMALCameraConfig.Annotate.Justify; var xOffset = MMALCameraConfig.Annotate.XOffset; var yOffset = MMALCameraConfig.Annotate.YOffset; if (!string.IsNullOrEmpty(MMALCameraConfig.Annotate.CustomText)) { sb.Append(MMALCameraConfig.Annotate.CustomText + " "); } if (MMALCameraConfig.Annotate.ShowTimeText) { sb.Append(DateTime.Now.ToString("HH:mm") + " "); } if (MMALCameraConfig.Annotate.ShowDateText) { sb.Append(DateTime.Now.ToString("dd/MM/yyyy") + " "); } if (MMALCameraConfig.Annotate.ShowShutterSettings) { showShutter = 1; } if (MMALCameraConfig.Annotate.ShowGainSettings) { showAnalogGain = 1; } if (MMALCameraConfig.Annotate.ShowLensSettings) { showLens = 1; } if (MMALCameraConfig.Annotate.ShowCafSettings) { showCaf = 1; } if (MMALCameraConfig.Annotate.ShowMotionSettings) { showMotion = 1; } if (MMALCameraConfig.Annotate.ShowFrameNumber) { showFrame = 1; } if (MMALCameraConfig.Annotate.AllowCustomBackgroundColour) { enableTextBackground = 1; } textSize = Convert.ToByte(MMALCameraConfig.Annotate.TextSize); if (MMALCameraConfig.Annotate.TextColour != Color.Empty) { customTextColor = 1; var yuv = MMALColor.RGBToYUVBytes(MMALCameraConfig.Annotate.TextColour); customTextY = yuv.Item1; customTextU = yuv.Item2; customTextV = yuv.Item3; } if (MMALCameraConfig.Annotate.BgColour != Color.Empty) { customBackgroundColor = 1; var yuv = MMALColor.RGBToYUVBytes(MMALCameraConfig.Annotate.BgColour); customBackgroundY = yuv.Item1; customBackgroundU = yuv.Item2; customBackgroundV = yuv.Item3; } string t = sb.ToString() + char.MinValue; var text = Encoding.ASCII.GetBytes(t); var strV4 = new MMAL_PARAMETER_CAMERA_ANNOTATE_V4_T( new MMAL_PARAMETER_HEADER_T(MMAL_PARAMETER_ANNOTATE, Marshal.SizeOf <MMAL_PARAMETER_CAMERA_ANNOTATE_V4_T>() + t.Length), 1, showShutter, showAnalogGain, showLens, showCaf, showMotion, showFrame, enableTextBackground, customBackgroundColor, customBackgroundY, customBackgroundU, customBackgroundV, 0, customTextColor, customTextY, customTextU, customTextV, textSize, text, (int)justify, xOffset, yOffset); var ptrV4 = Marshal.AllocHGlobal(Marshal.SizeOf <MMAL_PARAMETER_CAMERA_ANNOTATE_V4_T>()); Marshal.StructureToPtr(strV4, ptrV4, false); try { MMALCheck(MMALPort.mmal_port_parameter_set(camera.Control.Ptr, (MMAL_PARAMETER_HEADER_T *)ptrV4), "Unable to set annotate"); } catch { Marshal.FreeHGlobal(ptrV4); ptrV4 = IntPtr.Zero; MMALLog.Logger.Warn("Unable to set V4 annotation structure. Trying V3. Please update firmware to latest version."); var str = new MMAL_PARAMETER_CAMERA_ANNOTATE_V3_T( new MMAL_PARAMETER_HEADER_T(MMAL_PARAMETER_ANNOTATE, Marshal.SizeOf <MMAL_PARAMETER_CAMERA_ANNOTATE_V3_T>() + t.Length), 1, showShutter, showAnalogGain, showLens, showCaf, showMotion, showFrame, enableTextBackground, customBackgroundColor, customBackgroundY, customBackgroundU, customBackgroundV, 0, customTextColor, customTextY, customTextU, customTextV, textSize, text); var ptr = Marshal.AllocHGlobal(Marshal.SizeOf <MMAL_PARAMETER_CAMERA_ANNOTATE_V3_T>()); Marshal.StructureToPtr(str, ptr, false); try { MMALCheck(MMALPort.mmal_port_parameter_set(camera.Control.Ptr, (MMAL_PARAMETER_HEADER_T *)ptr), "Unable to set annotate V3."); } finally { Marshal.FreeHGlobal(ptr); } } finally { if (ptrV4 != IntPtr.Zero) { Marshal.FreeHGlobal(ptrV4); } } } }