using System; using System.Collections.Generic; using System.Linq; using System.Text; using System.Net; using System.IO; using System.Drawing; using System.Threading; using log4net; namespace ArdupilotMega.Utilities { public class CaptureMJPEG { private static readonly ILog log = LogManager.GetLogger(System.Reflection.MethodBase.GetCurrentMethod().DeclaringType); static Thread asyncthread; static bool running = false; public static string URL = @"http://127.0.0.1:56781/map.jpg"; public static event EventHandler OnNewImage; static DateTime lastimage = DateTime.Now; static int fps = 0; public static void runAsync() { while (running && asyncthread != null && asyncthread.IsAlive) { running = false; } asyncthread = new Thread(new ThreadStart(getUrl)) { IsBackground = true, Priority = ThreadPriority.BelowNormal, Name = "mjpg stream reader" }; asyncthread.Start(); } public static void Stop() { running = false; } static void getUrl() { running = true; Bitmap frame = new Bitmap(640, 480); // Create a request using a URL that can receive a post. WebRequest request = HttpWebRequest.Create(URL); // Set the Method property of the request to POST. request.Method = "GET"; ((HttpWebRequest)request).AutomaticDecompression = DecompressionMethods.GZip | DecompressionMethods.Deflate; request.Headers.Add("Accept-Encoding", "gzip,deflate"); // Get the response. WebResponse response = request.GetResponse(); // Display the status. log.Debug(((HttpWebResponse)response).StatusDescription); // Get the stream containing content returned by the server. Stream dataStream = response.GetResponseStream(); StreamReader sr = new StreamReader(dataStream); // get boundary header string mpheader = response.Headers["Content-Type"]; int startboundary = mpheader.IndexOf("boundary=") + 9; int endboundary = mpheader.Length; mpheader = mpheader.Substring(startboundary, endboundary - startboundary); while (running) { try { // get the multipart start header int length = int.Parse(getHeader(sr)["Content-Length"]); // read boundary header if (length > 0) { byte[] buf1 = new byte[length]; dataStream.ReadTimeout = 3000; int offset = 0; int len = 0; while ((len = dataStream.Read(buf1, offset, length)) > 0) { offset += len; length -= len; } frame = new Bitmap(new MemoryStream(buf1)); fps++; if (lastimage.Second != DateTime.Now.Second) { Console.WriteLine("MJPEG " + fps); fps = 0; lastimage = DateTime.Now; } if (OnNewImage != null) OnNewImage(frame, new EventArgs()); } // blank line at end of data sr.ReadLine(); } catch (Exception ex) { log.Info(ex); break; } } // clear last image if (OnNewImage != null) OnNewImage(null, new EventArgs()); dataStream.Close(); response.Close(); running = false; } static void getUrlRTSP() { } static Dictionary getHeader(StreamReader stream) { Dictionary answer = new Dictionary(); string line; do { line = stream.ReadLine(); string[] items = line.Split(new char[] { ':' }, StringSplitOptions.RemoveEmptyEntries); if (items.Length == 2) answer.Add(items[0].Trim(), items[1].Trim()); } while (line != ""); return answer; } } }