forked from ArduPilot/MissionPlanner
-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathexample10-canlogfile.cs
125 lines (107 loc) · 3.75 KB
/
example10-canlogfile.cs
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
using MissionPlanner;
using MissionPlanner.Utilities;
using System;
using System.Collections.Generic;
using System.Drawing;
using System.IO;
using System.Linq;
using System.Text;
using System.Windows.Forms;
using MissionPlanner.Controls;
using Newtonsoft.Json;
using UAVCAN;
//loadassembly: UAVCAN
namespace CANLogExtract
{
public class Plugin : MissionPlanner.Plugin.Plugin
{
public override string Name
{
get { return "CAN Log Extract"; }
}
public override string Version
{
get { return "0.10"; }
}
public override string Author
{
get { return "Michael Oborne"; }
}
public override bool Init()
{
var but = new ToolStripMenuItem("CAN Log Extract");
but.Click += but_Click;
ToolStripItemCollection col = Host.FDMenuMap.Items;
// uncomment to enable
col.Add(but);
return true;
}
private void but_Click(object sender, EventArgs e)
{
OpenFileDialog ofd = new OpenFileDialog();
ofd.Filter = "can file|*.can";
if (ofd.ShowDialog() == DialogResult.OK)
{
SaveFileDialog sfd = new SaveFileDialog();
sfd.DefaultExt = "txt";
sfd.Filter = "txt|*.txt";
sfd.FileName = Path.GetFileNameWithoutExtension(ofd.FileName) + ".txt";
sfd.InitialDirectory = Path.GetDirectoryName(ofd.FileName);
if (sfd.ShowDialog() == DialogResult.OK)
{
UAVCAN.uavcan can = new uavcan();
using (var stream = sfd.OpenFile())
{
var data = File.ReadAllBytes(ofd.FileName);
bool packet = false;
can.MessageReceived += (frame, msg, id) =>
{
packet = true;
var str = ASCIIEncoding.ASCII.GetBytes("\n" + msg.GetType().Name + "=" + msg.ToJSON());
stream
.Write(str, 0, str.Length);
};
can.FrameReceived += (frame, payload) =>
{
var str = ASCIIEncoding.ASCII.GetBytes("\nFrame " + frame.ToJSON(Formatting.None) + payload.ToJSON(Formatting.None));
stream
.Write(str, 0, str.Length);
};
can.FrameError += (frame, payload) =>
{
var str = ASCIIEncoding.ASCII.GetBytes("\nError");
stream
.Write(str, 0, str.Length);
};
data.ForEach(b =>
{
try
{
can.Read((byte) b);
stream.WriteByte((byte) b);
}
catch (Exception ex)
{
var str = ASCIIEncoding.ASCII.GetBytes(ex.ToString());
stream
.Write(str, 0, str.Length);
}
});
}
}
}
}
public override bool Loaded()
{
return true;
}
public override bool Loop()
{
return true;
}
public override bool Exit()
{
return true;
}
}
}