Skip to content

Instantly share code, notes, and snippets.

@dj1711572002

dj1711572002/ITP_LPS_rev015.cs Secret

Created October 11, 2022 04:49
Show Gist options
  • Star 0 You must be signed in to star a gist
  • Fork 0 You must be signed in to fork a gist
  • Save dj1711572002/0a1a2229cd87fd46b5eeef33edd0b214 to your computer and use it in GitHub Desktop.
Save dj1711572002/0a1a2229cd87fd46b5eeef33edd0b214 to your computer and use it in GitHub Desktop.
Download ZIP
C# RTK Graph Analyze Pgm. F9P,M9NPVT　LowPassFileter ,Integration
Raw
ITP_LPS_rev015.cs
using System;
using System.Collections.Generic;
using System.ComponentModel;
using System.Data;
using System.Drawing;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using System.Windows.Forms;
using System.IO.Ports;
using System.Diagnostics;
using Microsoft.VisualBasic.FileIO;
using static System.Windows.Forms.AxHost;
using System.Drawing.Drawing2D;
namespace ITP_LPS_rev015
{
public partial class Form1 : Form
{
const int blen = 3000;//処理データ単位３０００行を１ブロックにしてBitmapメモリー節約
int rN;
int rowN;//dgv rowCount
String fname;
public double[] f;
public double[] fout;
public double [] fkekka;
//
int[,] dgv=new int[30000,16];
double[,] dgv16_MA = new double[30000, 5];//FilteredData：M9N_gSpeed_MA(16),M9N_headMot_MA(17),M9N_velN_MA(18),M9N_velE_MA(19),M9N_velD(20)
double[,] dgv21_Igr = new double[30000, 8];//積分要素F9P：igr_F9P_gSpeed(21),igr_F9P_velN(22),igr_F9P_velE(23),igr_F9P_velD(24)
//積分要素M9N：igr_M9N_gSpeed_MA(25),igr_M9N_velN_MA(26),igr_M9N_velE_MA(27),igr_M9N_velD_MA(28)
//bitmap definition
//picturebox size-----------
const int pic1w=1000 ;//pictrueBox1　 幅
const int pic1h=500 ;//pictureBox1 　高さ
const int pic2w = 500;　
const int pic2h = 500;
const int pic3w = 500;
const int pic3h = 500;
const int bw = 20000;// blen;//180000 ;
const int xysize = 10000;
int wakuflag = 0;
Bitmap sourceBitmap = new Bitmap(bw, pic1h);//X軸bw個 data(10msec周期で300秒） Y軸
Bitmap trimmedBitmap = new Bitmap(pic1w, pic1h);//PictuerBox1に貼りこむBitmap
Bitmap xyBitmap = new Bitmap(xysize, xysize);//xyプロットのソース
Bitmap xysBitmap = new Bitmap(xysize, xysize);//xyプロットのソース拡大用Bitmapとしてポイントサイズを１に最小化した
Bitmap p2Bitmap = new Bitmap(pic2w,pic2h);//picturebox2のBitmap
Bitmap p2sBitmap = new Bitmap(pic2w, pic2h);//picturebox2の拡大用Bitmapとしてポイントサイズを１に最小化した
Bitmap p2wBitmap = new Bitmap(pic2w, pic2h);//picturebox2の枠用Bitmap
Bitmap p3Bitmap = new Bitmap(pic3w, pic3h);//picturebox2のBitmap
//-XYPLOT-----------------
double scalex, scaley;
double scale0 = 1;
int blockn = 0;//データブロックNo ComboBox7のINDEX値
int blockn_1 = 0;//1個前のブロックNo
long lonW, latH;
long [] maxlon =new long [10];
long [] minlon =new long[10];
long [] maxlat = new long[10];
long [] minlat = new long[10];
int a =1;
int a_1 = 1;
double wheelPos = 0;// Mouse Wheel Position
double wheelVal;
//xycut
int lefttopx;//= (int)(cutcenterx - (pic2w / 2) / magni);//切り取り四角座標計算
int lefttopy;//= (int)(cutcentery - (pic2h / 2) / magni);
int pointrowN;//pictureBox3 クリックで得た指定行No
//-------------------データブロック構造体----------------------------
public struct data_block
{
public int blockSize;
public int blockNo;
public int startRow;
public int endRow;
public long maxlon;
public long minlon;
public long maxlat;
public long minlat;
public long lonW;//全幅
public long latH;//全高
public int[] nutralN;//ニュートラルポイントの行No　配列
}
data_block[] dbk;
int alln;//全ブロック数
//--------------------------------------------------------------------
int px_1, py_1;
//prown 　クリック座標逆引き配列
int[] prownx ;
int[] prowny;
//----------------------------------------------------------------
//ComboBoxArray
private System.Windows.Forms.ComboBox[] CBarry;
//CheckBox Arry
private System.Windows.Forms.CheckBox[] CKarry;
//picturebox2
int cp2x, cp2y;//Mouse座標
//Struct GraphLine
public Color []samples= new Color[] { Color.Red, Color.Blue, Color.Green ,Color.Yellow,Color.Aqua,Color.DeepPink,Color.BlanchedAlmond};
struct lines
{
public string name;//LIne名　選択されたデータ名
public bool available;//Lineが有効：true 無効：false
public int colN;//Column番号
public Color clr;
public int sa;//data 間隔
public int rN_avail;
public int period;
public int x;
public int x_1;
public int y;
public int y_1;
public int max;
public int min;
public int baseL;//Graph base Line 1/2 1/1
public int uscale;//headMot=100000
}
lines[] gline;//gline global
public Form1()
{
InitializeComponent();
}
private void button1_Click(object sender, EventArgs e)
{
serialPort1.BaudRate = 115200;
serialPort1.Parity = Parity.None;
serialPort1.DataBits = 8;
serialPort1.StopBits = StopBits.One;
serialPort1.Handshake = Handshake.None;
serialPort1.PortName = portComboBox.Text;
serialPort1.Open();
//file name timestanmp
DateTime dt = DateTime.Now;
fname = dt.ToString($"{dt:MMddHHmm}");
string fpath = "C:/RTK_LOG/";
fname = fpath + fname + ".csv";
textBox2.Text = fname;
}
private void Form1_Load(object sender, EventArgs e)
{
this.Text = "ITP_LPS_rev015";
string[] ports = SerialPort.GetPortNames();
foreach (string port in ports)
{
portComboBox.Items.Add(port);
}
if (portComboBox.Items.Count > 0)
{
portComboBox.SelectedIndex = 0;
}
rN = 0;
//
//---------------------------------
// this.MouseWheel += new System.Windows.Forms.MouseEventHandler(this.Form1_MouseWheel);
//comboBox7 MovingAverage 初期値０
// dbk[blockn].nutralN = new int[blen + 3];//nutralN 配列初期化 blockSize分確保
//comboBox配列で一括定義------------------------------
this.CBarry = new System.Windows.Forms.ComboBox[6];
this.CKarry = new System.Windows.Forms.CheckBox[6];
//ボタンコントロールの配列にすでに作成されているインスタンスを代入
this.CBarry[0] = this.comboBox1;
this.CBarry[1] = this.comboBox2;
this.CBarry[2] = this.comboBox3;
this.CBarry[3] = this.comboBox4;
this.CBarry[4] = this.comboBox5;
this.CBarry[5] = this.comboBox6;
//チェックボックス配列
this.CKarry[0] = this.checkBox2;
this.CKarry[1] = this.checkBox3;
this.CKarry[2] = this.checkBox4;
this.CKarry[3] = this.checkBox5;
this.CKarry[4] = this.checkBox6;
this.CKarry[5] = this.checkBox7;
//combobox color
// comboBox1.BackColor = Color.Red;
int ia;
for (ia = 0; ia <6; ia++)
{
CBarry[ia].BackColor=samples[ia];
CBarry[ia].Items.Add("無し");
CBarry[ia].Items.Add("No");
CBarry[ia].Items.Add("itow");
CBarry[ia].Items.Add("f9p_gSpeed(10Hz)");
CBarry[ia].Items.Add("f9p_gSpeed(50Hz)");
CBarry[ia].Items.Add("f9p_headMot(10Hz)");
CBarry[ia].Items.Add("f9p_headMot(50Hz)");
CBarry[ia].Items.Add("lon(10Hz)");
CBarry[ia].Items.Add("lon(50Hz)");
CBarry[ia].Items.Add("lat(10Hz)");
CBarry[ia].Items.Add("lat(50Hz)");
CBarry[ia].Items.Add("f9p_velN(10Hz)");
CBarry[ia].Items.Add("f9p_velN(50Hz)");
CBarry[ia].Items.Add("f9p_velE(10Hz)");
CBarry[ia].Items.Add("f9p_velE(50Hz)");
CBarry[ia].Items.Add("f9p_velD(10Hz)");
CBarry[ia].Items.Add("f9p_velD(50Hz)");
CBarry[ia].Items.Add("flags");
CBarry[ia].Items.Add("hacc");
CBarry[ia].Items.Add("m9n_gSpeed(25Hz)");
CBarry[ia].Items.Add("m9n_gSpeed(50Hz)");
CBarry[ia].Items.Add("m9n_headMot(25Hz)");
CBarry[ia].Items.Add("m9n_headMot(50Hz)");
CBarry[ia].Items.Add("m9n_velN(25Hz)");
CBarry[ia].Items.Add("m9n_velN(50Hz)");
CBarry[ia].Items.Add("m9n_velE(25Hz)");
CBarry[ia].Items.Add("m9n_velE(50Hz)");
CBarry[ia].Items.Add("m9n_velD(25Hz)");
CBarry[ia].Items.Add("m9n_velD(50Hz)");
//MA
CBarry[ia].Items.Add("m9n_gSpeed_MA(25Hz)");
CBarry[ia].Items.Add("m9n_gSpeed_MA(50Hz)");
CBarry[ia].Items.Add("m9n_headMot_MA(25Hz)");
CBarry[ia].Items.Add("m9n_headMot_MA(50Hz)");
CBarry[ia].Items.Add("m9n_velN_MA(25Hz)");
CBarry[ia].Items.Add("m9n_velN_MA(50Hz)");
CBarry[ia].Items.Add("m9n_velE_MA(25Hz)");
CBarry[ia].Items.Add("m9n_velE_MA(50Hz)");
CBarry[ia].Items.Add("m9n_velD_MA(25Hz)");
CBarry[ia].Items.Add("m9n_velD_MA(50Hz)");
CBarry[ia].SelectedIndex = 0;
}
comboBox1.SelectedIndex = 3;//F9P gSpeed 初期値
//Mouse Wheel
this.MouseWheel += new MouseEventHandler(Form1_MouseWheel);
label5.Text = "1";
　
}
private void Form1_MouseWheel(object sender, MouseEventArgs e)
{
double stepplus = 1;
double stepplus1 = 0.05;
double stepminus1 = -1;
double stepminus = -0.05;
if (e.Delta > 0 && wheelVal>1)//拡大倍率　1>wheelVal
{
//wheelVal =(e.Delta/120 + Convert.ToInt32(label4.Text));
wheelVal = (stepplus + Convert.ToDouble(label5.Text));
}
else if (e.Delta > 0 && wheelVal <= 1)//1倍以下で拡大方向　　
{
wheelVal = (stepplus1 + Convert.ToDouble(label5.Text));
if (wheelVal <= 0)
{
wheelVal = 0.01;
}
else
{
wheelVal = wheelVal;
}
}
else if (e.Delta < 0 && wheelVal<=1)//縮小倍率　１< wheelVal
{
wheelVal =(stepminus + Convert.ToDouble(label5.Text) );
if (wheelVal <= 0)
{
wheelVal = 0.01 ;
}
else
{
wheelVal = wheelVal;
}
}
else if (e.Delta<0 && wheelVal>1)
{
wheelVal = (stepminus1 + Convert.ToDouble(label5.Text));
if (wheelVal <= 0)
{
wheelVal = 0.01;
}
else
{
wheelVal = wheelVal;
}
}
Debug.Print("e.Delta="+e.Delta.ToString()+",wheelVal=" + wheelVal.ToString());
//label4.Text ="倍率";
label5.Text = wheelVal.ToString("n2");
}
private void name2gline(int comN)
{
string name= CBarry[comN].Text;
gline[comN].name = name;
gline[comN].clr = samples[comN];
gline[comN].available = true;
gline[comN].max = 10000;
gline[comN].min = -10000;
gline[comN].baseL = 2;
gline[comN].uscale = 1;
int coln= 0;
if (name == "無し") { gline[comN].colN = -1;gline[comN].available = false; }
if (name == "No") { gline[comN].colN = 0; }
if (name == "itow") { gline[comN].colN = 1; }
if (name == "f9p_gSpeed(10Hz)") { gline[comN].colN = 2; gline[comN].sa = 5;gline[comN].period = 100; }
if (name == "f9p_gSpeed(50Hz)") { gline[comN].colN = 2; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "f9p_headMot(10Hz)") { gline[comN].colN = 3; gline[comN].sa = 5; gline[comN].period = 100;gline[comN].max = 36000000; gline[comN].min = 0;gline[comN].baseL = 1; gline[comN].uscale = 100000; }
if (name == "f9p_headMot(50Hz)") { gline[comN].colN = 3; gline[comN].sa = 1; gline[comN].period = 20;gline[comN].max = 36000000; gline[comN].min = 0; gline[comN].baseL = 1; gline[comN].uscale = 100000; }
if (name == "lon(10Hz)") { gline[comN].colN = 4; gline[comN].sa = 5; gline[comN].period = 100; }
if (name == "lon(50Hz)") { gline[comN].colN = 4; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "lat(10Hz)") { gline[comN].colN = 5; gline[comN].sa = 5; gline[comN].period = 100; }
if (name == "lat(50Hz)") { gline[comN].colN = 5; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "f9p_velN(10Hz)") { gline[comN].colN = 6; gline[comN].sa = 5; gline[comN].period = 100; }
if (name == "f9p_velN(50Hz)") { gline[comN].colN = 6; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "f9p_velE(10Hz)") { gline[comN].colN = 7; gline[comN].sa = 5; gline[comN].period = 100; }
if (name == "f9p_velE(50Hz)") { gline[comN].colN = 7; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "f9p_velD(10Hz)") { gline[comN].colN = 8; gline[comN].sa = 5; gline[comN].period = 100; }
if (name == "f9p_velD(50Hz)") { gline[comN].colN = 8; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "flags") { gline[comN].colN = 9;}
if (name == "hacc") { gline[comN].colN = 10; }
if (name == "m9n_gSpeed(25Hz)") { gline[comN].colN = 11; gline[comN].sa = 2; gline[comN].period =40; }
if (name == "m9n_gSpeed(50Hz)") { gline[comN].colN = 11; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "m9n_headMot(25Hz)") { gline[comN].colN = 12; gline[comN].sa = 2; gline[comN].period = 40; gline[comN].max = 36000000; gline[comN].min = 0; gline[comN].baseL = 1; gline[comN].uscale = 100000; }
if (name == "m9n_headMot(50Hz)") { gline[comN].colN = 12; gline[comN].sa = 1; gline[comN].period = 20; gline[comN].max = 36000000; gline[comN].min = 0; gline[comN].baseL = 1; gline[comN].uscale = 100000; }
if (name == "m9n_velN(25Hz)") { gline[comN].colN = 13; gline[comN].sa = 2; gline[comN].period = 40; }
if (name == "m9n_velN(50Hz)") { gline[comN].colN = 13; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "m9n_velE(25Hz)") { gline[comN].colN = 14; gline[comN].sa = 2; gline[comN].period = 40; }
if (name == "m9n_velE(50Hz)") { gline[comN].colN = 14; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "m9n_velD(25Hz)") { gline[comN].colN = 15; gline[comN].sa = 2; gline[comN].period = 40; }
if (name == "m9n_velD(50Hz)") { gline[comN].colN = 15; gline[comN].sa = 1; gline[comN].period = 20; }
//MA
if (name == "m9n_gSpeed_MA(25Hz)") { gline[comN].colN = 16; gline[comN].sa = 2; gline[comN].period = 40; }
if (name == "m9n_gSpeed_MA(50Hz)") { gline[comN].colN = 16; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "m9n_headMot_MA(25Hz)") { gline[comN].colN = 17; gline[comN].sa = 2; gline[comN].period = 40; gline[comN].max = 36000000; gline[comN].min = 0; gline[comN].baseL = 1; gline[comN].uscale = 100000; }
if (name == "m9n_headMot_MA(50Hz)") { gline[comN].colN = 17; gline[comN].sa = 1; gline[comN].period = 20; gline[comN].max = 36000000; gline[comN].min = 0; gline[comN].baseL = 1; gline[comN].uscale = 100000; }
if (name == "m9n_velN_MA(25Hz)") { gline[comN].colN = 18; gline[comN].sa = 2; gline[comN].period = 40; }
if (name == "m9n_velN_MA(50Hz)") { gline[comN].colN = 18; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "m9n_velE_MA(25Hz)") { gline[comN].colN = 19; gline[comN].sa = 2; gline[comN].period = 40; }
if (name == "m9n_velE_MA(50Hz)") { gline[comN].colN = 19; gline[comN].sa = 1; gline[comN].period = 20; }
if (name == "m9n_velD_MA(25Hz)") { gline[comN].colN = 20; gline[comN].sa = 2; gline[comN].period = 40; }
if (name == "m9n_velD_MA(50Hz)") { gline[comN].colN = 20; gline[comN].sa = 1; gline[comN].period = 20; }
}
//*****************************************************************************************************************************
//---------Filter ボタン5 クリック-----------------------------------------------------------------
private void button5_Click(object sender, EventArgs e)
{
//*******************************************************************************************************************
// BryantFilter2(double[] f,double []fout, int rowmin, int rowmax, int colmin, int colmax, double fc, double fs)
//*******************************************************************************************************************
//Input Array making 11:M9N_gSpeed,12:M9N_headMot,13:M9N_velN,14:M9N_velE,15:M9N_velD
int i,j,k, n;
int l = 0;
int m = 0;
int roN = dgv1.RowCount;
f = new double[roN];//Globalで定義
fout= new double[roN];//Globalで定義
fkekka = new double[rowN];//Globalで定義
int fc = Convert.ToInt32(textBox12.Text);// 2;//CUt off Hz
int fs = Convert.ToInt32(textBox11.Text);//25;//Sampling Hz
for (i = 11; i < 16; i++)//列カウンタ//M9N 11=gSpeed,12=headMot,13=velN,14=velE,15=velD
{
m = 0;
for (j = 0; j < roN - 1; j++)//f配列作成
{
int itow = Convert.ToInt32(dgv1.Rows[j].Cells[1].Value);
if (itow % 40 == 0)//25Hzデータ抽出
{
f[m] = Convert.ToDouble(dgv1.Rows[j].Cells[i].Value);
double dummy = f[m];
// Debug.Print("Make:f[" + m.ToString() + ",0]=" + f[m, 0].ToString());
m++;
}
}
//BryantFilter2(double[] f,double []fout, int rowmin, int rowmax, int colmin, int colmax, double fc, double fs)
BryantFilter2(f, fout, 1, m - 1, 0, 1, fc, fs);
Debug.Print("Filter Finished m-1=" + (m - 1).ToString());
int mi = 0;
dgv1.Columns[0].DefaultCellStyle.WrapMode = DataGridViewTriState.True;
dgv1.AutoSizeColumnsMode = DataGridViewAutoSizeColumnsMode.None;
dgv1.AutoSizeRowsMode = DataGridViewAutoSizeRowsMode.None;
//FilterデータをDGVへ入力--------------------------------------------------------
for (l = 0; l < roN; l++)//行ループ
{
int itow = Convert.ToInt32(dgv1.Rows[l].Cells[1].Value);
if (itow % 40 == 0)//M9N 40msec周期で入力　１行飛び
{
int ifout = Convert.ToInt32(fout[mi]);
dgv1.Rows[l].Cells[i + 5].Value = fout[mi].ToString("F2");// 16列M9N_gSpeed_MA,17列:M9N_headMot,18列:M9N_velN,19列:M9N_velE,20列:M9N_velD
dgv16_MA[l, i -11] = fout[mi];
//Debug.Print("Kekka:fout[" + l.ToString() + "]=" + fout[mi].ToString() + "fkekka=" + fkekka[mi].ToString());
mi++;
}
else if(l > 2)//直線補間で20msecを埋める
{
double row_3_val = Convert.ToDouble(dgv1.Rows[l -3].Cells[i + 5].Value);//現在行から３行前
double row_1_val = Convert.ToDouble(dgv1.Rows[l-1].Cells[i + 5].Value);//現在行から１行手前
dgv16_MA[l, i -11] = (row_3_val + row_1_val) / 2;
dgv1.Rows[l - 2].Cells[i + 5].Value =( (row_3_val + row_1_val) / 2).ToString("F2");
}
}
}
// ====================積分要素計算:F9Pとフィルター済みのM9Nデータ========================================================//
if (checkBox9.Checked==true)
{
int ii, jj;
double dt = 0.02;
double dummy;
for(ii=2;ii<dgv1.RowCount-1;ii++)//行ループ
{
//F9P積分要素------------------------------------------------------------
//F9P_gSpeed(2)=>igr_F9P_gSpeed(21),F9P_velN(6)=>igr_F9P_velN(22),F9P_velE(7)=>igr_F9P_velE(23),F9P_velD(8)=>igr_F9P_velD(24)
dgv21_Igr[ii, 0] =(double)( dgv[ii, 2] + dgv[ii-1,2])/2*dt;//F9P_gSpeed(2)=>Igr(21)
dgv21_Igr[ii, 1] = (double)(dgv[ii, 6] + dgv[ii - 1, 6]) / 2 * dt;//F9P_velN(6)=>Igr(22)
dgv21_Igr[ii, 2] = (double)(dgv[ii, 7] + dgv[ii - 1, 7]) / 2 * dt;//F9P_velE(7)=>Igr(23)
dgv21_Igr[ii, 3] = (double)(dgv[ii, 8] + dgv[ii - 1, 8]) / 2 * dt;//F9P_velD(8)=>Igr(24)
//M9N積分要素:M9N_gSpeed_MA(Filtered)を積分してigr----------------------------------------------------------
//M9N_gSpeed_MA:(16),M9N_velN_MA:(18),M9N_velE_MA:(19),M9N_velD_MA:(20)
dgv21_Igr[ii, 4] = (double)(dgv16_MA[ii, 0] + dgv16_MA[ii - 1,0]) / 2 * dt;//M9N_gSpeed_MA(16)=>Igr(25)
dgv21_Igr[ii, 5] = (double)(dgv16_MA[ii, 2] + dgv16_MA[ii - 1, 2]) / 2 * dt;//M9N_velN_MA(18)=>Igr(26)
dgv21_Igr[ii, 6] = (double)(dgv16_MA[ii, 3] + dgv16_MA[ii - 1, 3]) / 2 * dt;//M9N_velE_MA(19)=>Igr(27)
dgv21_Igr[ii, 7] = (double)(dgv16_MA[ii, 4] + dgv16_MA[ii - 1, 4]) / 2 * dt;//M9N_velE_MA(20)=>Igr(28)
// if (Convert.ToInt32(dgv1.Rows[ii].Cells[1].Value)%40==20)//40msec毎に計算
// {
//dgv 書き込みの場合
if (checkBox1.Checked == true)
{
int igrcol;
for (igrcol = 0; igrcol < 8; igrcol++)
{
dgv1.Rows[ii].Cells[igrcol+21].Value = dgv21_Igr[ii,igrcol].ToString("F2") ;
}
}
}
}
}//button5 filter
//=======================================================================================
//=======================Low Pass Filter=================================================
//=======================================================================================
//private void BryantFilter2(double[,] f,double [,]fout, int rowmin, int rowmax, int colmin, int colmax, double fc, double fs)
private void BryantFilter2(double[] f, double []fout, int rowmin, int rowmax, int colmin, int colmax, double fc, double fs)
{
int i, j;
double[] temp = new double[rowmax];
for(i=rowmin;i<rowmax;i++)
{
for (j = colmin; j <= colmax; j++)
{
temp[i] = f[i];
fout[i] = f[i];
// Debug.Print("temp[" + i.ToString() + ",0]=" + temp[i, 0].ToString());
}
}
//Bryant のバターワースフィルタ，臨床歩行分析入門より
double FF,W,B,c,D;
FF = fc / fs;
W = Math.Tan(3.14159 * FF);
B = 1 + Math.Sqrt(2) * W + W * W;
c = 2 * (1 - W * W) / B;
D = -(1 - Math.Sqrt(2) * W + W * W) / B;
j =0;
for (i = rowmin + 2; i < rowmax-1; i ++)
{
fout[i] = (temp[i] + 2 * temp[i - 1] + temp[i - 2]) * W *W / B + c * fout[i - 1] + D * fout[i - 2];
// Debug.Print("InFilter:temp["+i.ToString()+","+j.ToString()+"]=" + temp[i].ToString() + ",fout["+i.ToString()+"]=" + fout[i].ToString());
}
Debug.Print("Pass1"+"rowmax="+rowmax.ToString());
//反対側からもう一度
for (i = rowmin; i < rowmax; i++)
{
j = 0;
temp[i] = fout[i];
}
for( i = rowmax -3;i> rowmin;i--)
{
fout[i] = (temp[i] + 2 * temp[i + 1] + temp[i + 2]) * W * W / B + c * fout[i + 1] + D * fout[i + 2];
fkekka[i] = fout[i];
// Debug.Print("GyakunFilter:temp[" + i.ToString()+ "]=" + temp[i].ToString() + ",fout[]=" + fout[i].ToString(), "fkekka=" + fkekka[i].ToString());
}
}// BryantFileter END=================================================================
//====================================================================================
//---------------------private void countCombo　グラフデータのセレクションを設定-----------------------------------------
private void countCombo()
{
//構造体
this.gline = new lines[6];
int icom;//combobox No
for (icom = 0; icom < 6; icom++)
{
//name2gline(icom);
gline[icom].uscale = 1;
if (CBarry[icom].SelectedIndex > 0)
{
gline[icom].available = true;
name2gline(icom);
// .AppendText(gline[icom].name + ","+gline[icom].colN+","+gline[icom].sa+","+gline[icom].period+","+"\r");
}
else
{
gline[icom].available = false;
}
}
}
// -------------------------------button 2　Serial受信開始------------------------------------------
private void button2_Click(object sender, EventArgs e)
{
pictureBox1.Visible = false;
ReadDialog();
}
delegate void SetTextCallback(string text);
private void Response(string text)
{
if (textBox1.InvokeRequired)
{
SetTextCallback d = new SetTextCallback(Response);
BeginInvoke(d, new object[] { text });
}
else
{
// textBox1.AppendText(text + "\n");
//===============データグリッドビュー　dgv1へ記録===================
// string[] data =( text+",\n").Split(',');//カンマ区切りにばらす
string[] data = text.Split(',');//カンマ区切りにばらす
int cN = 21;// data.Length16+5;
//data[] to string
int iN;
string datas = "";
for (iN = 0; iN < cN; iN++)
{
datas = datas + "," + data[iN];
// Debug.Print("data[" + iN.ToString() + "]=" + data[iN]);
}
datas = datas + "\r\n";
// Debug.Print("rN=" + rN.ToString()+"text=" + datas);
// 自動csv保存 書き込むファイルが既に存在している場合は、Appendする
System.IO.StreamWriter sw = new System.IO.StreamWriter(@fname, true, System.Text.Encoding.GetEncoding("shift_jis"));
//TextBox1.Textの内容を書き込む
sw.Write(datas);
//閉じる
sw.Close();
if (rN == 0)//行カウントrN==0のときdgv1定義
{
//dgv1.DefaultCellStyle.Font = new Font("Tahoma", 10);
//dgv1.RowHeadersWidthSizeMode = DataGridViewRowHeadersWidthSizeMode.AutoSizeToAllHeaders;
dgv1.ColumnCount = cN;
dgv1.RowCount = 2;
dgv1.RowHeadersWidth = 100;
dgv1.Columns[0].DefaultCellStyle.WrapMode = DataGridViewTriState.True;
// dgv1.Columns[0].DefaultCellStyle.Alignment =DataGridViewContentAlignment.TopLeft;
}
rN++;
dgv1.FirstDisplayedScrollingRowIndex = rN;
dgv1.Rows.Add(data);//dgv1書き込み
dgv1.Rows[rN].HeaderCell.Value = rN.ToString();
//=================================================================
}
}
private void serialPort1_DataReceived(object sender, SerialDataReceivedEventArgs e)
{
serialPort1.NewLine = "\r\n";
string str = serialPort1.ReadLine();
Response(str);
}
private void button3_Click(object sender, EventArgs e)
{
serialPort1.Close();
}
//****************************************************************************************************************
//****************************************************************************************************************
//==================Open File Dialog READ FILE==============================
//****************************************************************************************************************
//****************************************************************************************************************
private void ReadDialog()
{
int irn = 0;
int icn = 0;
//sourceBitmap_clear();
//OpenFileDialogクラスのインスタンスを作成
OpenFileDialog ofd = new OpenFileDialog();
//ダイアログを表示する
if (ofd.ShowDialog() == DialogResult.OK)
{
// DataGridView初期化（データクリア）
dgv1.Columns.Clear();
dgv1.Rows.Clear();
// dgv1 set
dgv1.ColumnCount = 29;
dgv1.RowCount = 2;
dgv1.RowHeadersWidth = 80;
dgv1.Columns[0].DefaultCellStyle.WrapMode = DataGridViewTriState.True;
dgv1.AutoSizeColumnsMode = DataGridViewAutoSizeColumnsMode.None;
dgv1.AutoSizeRowsMode = DataGridViewAutoSizeRowsMode.None;
headerName();
rowN = 0;
//OKボタンがクリックされたとき、選択されたファイルを読み取り専用で開く
textBox2.Text = ofd.FileName;
using (var parser = new TextFieldParser(ofd.FileName))////@"C:\Test\car1.csv"))
{
parser.Delimiters = new string[] { "," };
while (!parser.EndOfData)
{
//Console.WriteLine("-----");
string[] fields;
fields = parser.ReadFields();
rowN++;
//string sf = fields.ToString();
//string[] sdata=fields.Split(",");
int colsize = fields.Length;
int colcount;
for (colcount = 0; colcount < colsize; colcount++)
{
dgv[rowN, colcount] = Convert.ToInt32(fields[colcount]);
}
// dgv[rowN,]
if (checkBox1.Checked == true)
{
dgv1.Rows.Add(fields);//dgv1書き込み
dgv1.Rows[rowN].HeaderCell.Value = rowN.ToString();
}
}
label1.Text = "dgvRows=" + rowN.ToString();
}
}
//-----XY data_block 宣言------------------------------------
alln = Convert.ToInt32(Math.Ceiling((double)rowN / blen));
dbk = new data_block[alln+2];
long celval4, celval5;
//==================================================================================
//=========================block構造体　初期値　入力=====================================
//==================================================================================
int bn;
for (bn = 1; bn < alln+1; bn++)
{
// a = Convert.ToInt32(Math.Ceiling((double)irn / blen));//aはブロックNO、切り上げてカウント0-3000はブロックNo＝１
dbk[bn].blockSize = blen;
dbk[bn].blockNo = bn;
if (bn == 1)
{
dbk[bn].startRow = 1;
Debug.Print("dbk[" + bn.ToString() + "].startRow=" + dbk[bn].startRow);
}
else
{
dbk[bn].startRow = (bn - 1) * blen;
Debug.Print("dbk[" + bn.ToString() + "].startRow=" + dbk[bn].startRow);
}
if (bn <alln)
{
dbk[bn].endRow = bn * blen - 1;
}
else
{
dbk[bn].endRow =rowN-1;
}
Debug.Print("dbk[" + bn.ToString() + "].endRow=" + dbk[bn].endRow);
dbk[bn].maxlon = 0;
dbk[bn].minlon = 10000000000;
dbk[bn].maxlat = 0;
dbk[bn].minlat = 10000000000;
//combobox7 set
comboBox7.Items.Add(bn.ToString());
dbk[bn].nutralN = new int[blen +10];//nutralN 配列初期化 blockSize分確保
}
//-------------------------------------------------------------------------------
for (bn = 1; bn < alln+1; bn++)
{
for (irn = dbk[bn].startRow; irn < dbk[bn].endRow + 1; irn++)//行スキャン
{
celval4 = dgv[irn, 4];
celval5 = dgv[irn, 5];
if (dbk[bn].maxlon < celval4) { dbk[bn].maxlon = celval4; }
if (dbk[bn].minlon > celval4) { dbk[bn].minlon = celval4; }
if (dbk[bn].maxlat < celval5) { dbk[bn].maxlat = celval5; }
if (dbk[bn].minlat > celval5) { dbk[bn].minlat = celval5; }
}
Debug.Print("dbk["+ bn.ToString() + "].maxlon=" + dbk[bn].maxlon + ",dbk[].minlon=" + dbk[bn].minlon);
Debug.Print("dbk["+bn.ToString() + "].maxlat=" + dbk[bn].maxlat + ",dbk[].minlat=" + dbk[bn].minlat);
}
int ia;
//last Allblock ---------------
dbk[alln + 1].startRow = 1;
dbk[alln + 1].endRow = rowN - 1;
dbk[alln + 1].maxlon = 0;
dbk[alln + 1].minlon = 10000000000;
dbk[alln + 1].maxlat = 0;
dbk[alln + 1].minlat = 100000000000;
comboBox7.Items.Add((alln + 1).ToString());
Debug.Print("dbk[" + (alln + 1).ToString() + "].startRow=" + dbk[alln + 1].startRow);
Debug.Print("dbk[" + (alln + 1).ToString() + "].endRow=" + dbk[alln + 1].endRow);
for (ia = 1; ia <alln+1; ia++)
{
//lon max min
if (dbk[ia].maxlon> dbk[alln+1].maxlon) { dbk[alln+1].maxlon = dbk[ia].maxlon; }
if (dbk[ia].minlon < dbk[alln+1].minlon) { dbk[alln+1].minlon = dbk[ia].minlon; }
//lat max min
if (dbk[ia].maxlat> dbk[alln+1].maxlat) { dbk[alln+1].maxlat = dbk[ia].maxlat; }
if (dbk[ia].minlat < dbk[alln+1].minlat) { dbk[alln+1].minlat = dbk[ia].minlat; }
}
//------lonW latH -------------------------
for (ia = 1; ia < alln + 2; ia++)
{
dbk[ia].lonW = dbk[ia].maxlon - dbk[ia].minlon;
dbk[ia].latH = dbk[ia].maxlat - dbk[ia].minlat;
}
// All result
Debug.Print("All:dbk[alln+1].maxlon[" + (alln+1).ToString() + "]=" + dbk[alln+1].maxlon.ToString() + ",dbk[alln+1].minlon=" + dbk[alln+1].minlon.ToString());
Debug.Print("All:dbk[alln+1].maxlat[" + (alln+1).ToString() + "]=" + dbk[alln+1].maxlat.ToString() + ",dbk[alln+1].minlat=" + dbk[alln+1].minlat.ToString());
}//File read End 　*******************************************************************************************************************
//**********************************************************************************************************************:::
//***************************************************************************************************************************
//--readDialog() end-----------------------------------------------------------------------------------------------------
//======================================================
//===========dgvSave===================================
//====================================================
private void dgvsave()
{
int i,j;
//Filename Timestamp
DateTime dt = DateTime.Now;
string fn = dt.ToString($"{dt:MMddHHmmss}");
string fnstrng="c:/RTK_Log/dgv_"+fn+".csv";
string hdstrng= "c:/RTK_Log/head_" + fn + ".csv";
int dgvron = dgv1.RowCount;
int dgvcln = dgv1.ColumnCount;
Debug.Print("dgvron=" + dgvron.ToString() + ",dgvcln=" + dgvcln.ToString());
using (StreamWriter sw = new StreamWriter(@fnstrng, false, Encoding.UTF8))
{
for (i = 1; i < dgvron-1; i++)
{
string dgvrow = "";
for (j = 0; j < dgvcln; j++)
{
dgvrow = dgvrow + dgv1.Rows[i].Cells[j].Value+",";
}
sw.WriteLine(dgvrow);
}
}
//-----------HeaderText save----------------------
if (checkBox8.Checked == true)
{
using (StreamWriter sw = new StreamWriter(@hdstrng, false, Encoding.UTF8))
{
string dgvhead = "";
for (j = 0; j < dgvcln; j++)
{
dgvhead = dgvhead + dgv1.Columns[j].HeaderCell.Value+",";
//Debug.Print("i=" + i.ToString() + ",dgvhead=" + dgvhead);
}
sw.WriteLine(dgvhead);
}
}
}
private void checkBox1_CheckedChanged(object sender, EventArgs e)//PictureBox選択
{
if (checkBox1.Checked == true)
{
// pictureBox1.Visible = false;
dgv1.Visible = true;
pictureBox1.Visible = false;
pictureBox2.Visible = false;
pictureBox3.Visible = false;
}
else
{
dgv1.Visible = false;
//pictureBox1.Visible = true;
//pictureBox1.Visible = true;
pictureBox2.Visible = true;
pictureBox3.Visible = true;
}
}
private void headerName()
{
{
dgv1.ColumnHeadersDefaultCellStyle.Font = new Font(dgv1.Font, FontStyle.Bold);
//DataGridView1の行ヘッダーに行番号を表示する
dgv1.Columns[0].HeaderText = "No";
dgv1.Columns[1].HeaderText = "itow";
dgv1.Columns[2].HeaderText = "f9p_gSpeed";
dgv1.Columns[3].HeaderText = "f9p_headMot";
dgv1.Columns[4].HeaderText = "lon";
dgv1.Columns[5].HeaderText = "lat";
dgv1.Columns[6].HeaderText = "f9p_velN";
dgv1.Columns[7].HeaderText = "f9p_velE";
dgv1.Columns[8].HeaderText = "f9p_velD";
dgv1.Columns[9].HeaderText = "flags";
dgv1.Columns[10].HeaderText = "hacc";
dgv1.Columns[11].HeaderText = "m9n_gSpeed";
dgv1.Columns[12].HeaderText = "m9n_headMot";
dgv1.Columns[13].HeaderText = "m9n_velN";
dgv1.Columns[14].HeaderText = "m9n_velE";
dgv1.Columns[15].HeaderText = "m9n_velD";
//
dgv1.Columns[16].HeaderText = "m9n_gSpeed_MA";
dgv1.Columns[17].HeaderText = "m9n_headMot_MA";
dgv1.Columns[18].HeaderText = "m9n_velN_MA";
dgv1.Columns[19].HeaderText = "m9n_velE_MA";
dgv1.Columns[20].HeaderText = "m9n_velD_MA";
//
dgv1.Columns[21].HeaderText = "igr_f9p_gSpeed";
dgv1.Columns[22].HeaderText = "igr_f9p_velN";
dgv1.Columns[23].HeaderText = "igr_f9p_velE";
dgv1.Columns[24].HeaderText = "igr_f9p_velD";
dgv1.Columns[25].HeaderText = "igr_m9n_gSpeed_MA";
dgv1.Columns[26].HeaderText = "igr_m9n_velN_MA";
dgv1.Columns[27].HeaderText = "igr_m9n_velE_MA";
dgv1.Columns[28].HeaderText = "igr_m9n_velD_MA";
//ヘッダーとすべてのセルの内容に合わせて、列の幅を自動調整する
dgv1.AutoSizeColumnsMode = DataGridViewAutoSizeColumnsMode.AllCells;
int i;
for (i = 0; i < 29; i++)
{
dgv1.Rows[0].Cells[i].Value = i.ToString();
}
}
}
//============================================================================================================================
//==================PLOT4 ボタン押し=========================================
//============================================================================================================================
private void button4_Click(object sender, EventArgs e)//PLOT4　ボタン押してグラフ開始
{
if (checkBox10.Checked == true)
{
pictureBox1.Visible = true;
pictureBox2.Visible = false;
pictureBox3.Visible = false;
}
else
{
pictureBox1.Visible = false;
pictureBox2.Visible = true;
pictureBox3.Visible = true;
}
//グラフパラメータセッツアップ
//comboBox配列から読み取り
countCombo();//comboBox 6個からプロット列と周期を読み取るgline[]構造体を作成
//source Bitmapを作成
makeSrcBitmap();
int ir;
//pictureBox1.Visible = true;
hScrollBar1.Minimum = 0;
int xdot = timeScale();
hScrollBar1.Maximum = rowN*xdot;
hScrollBar1.Value = rowN*xdot;
textBox3.Text = Convert.ToInt32(hScrollBar1.Value/xdot).ToString();
Debug.Print("button4:xdot=" + xdot.ToString() + "hscrollBar.Max=" + hScrollBar1.Maximum);
sourceCut(rowN*xdot);
//xyplot
if (checkBox10.Checked==false)
{
xyplot();
}
}
// ------時系列グラフSourceBitmapの作成------------------------------
private void makeSrcBitmap()
{
int gsel;//gline selector
int irn;
int pw = pictureBox1.Width;
int ph = pictureBox1.Height;
int velMax = 10000;
int velMin = -10000;
int headMax = 36000000;
int headMin = 0;
int xdot = timeScale();
// double yscale = (double)ph / (velMax - velMin);
Graphics g1 = Graphics.FromImage(sourceBitmap);
g1.Clear(Color.Black);
for (gsel=0;gsel<6;gsel++)
{
if(gline[gsel].available==true)
{
int pmsec = gline[gsel].period;
int psa = gline[gsel].sa;
int pcoln = gline[gsel].colN;
double yscale = (double)ph / (gline[gsel].max - gline[gsel].min);
//Debug.Print("gline[" + gsel.ToString() + "].colN=" + gline[gsel].colN.ToString());
int itow0=0;
int y0, y0_1;
for (irn=2;irn<rowN;irn++)
{
if (checkBox1.Checked == true)
{ itow0 = Convert.ToInt32(dgv1.Rows[irn].Cells[1].Value); }
else
{ itow0 = dgv[irn, 1]; }
//Debug.Print("itow0=" + itow0.ToString() + "gline[" + gsel.ToString() + "].colN=" + gline[gsel].colN.ToString());
Pen p = new Pen(samples[gsel], 1);
Brush b1 = new SolidBrush(samples[gsel]);
if ( itow0%pmsec==0 && irn>psa)
{
// Debug.Print("irn=" + irn.ToString() + "psa=" + psa.ToString());
if (checkBox1.Checked == true)
{
y0 = Convert.ToInt32(dgv1.Rows[irn].Cells[pcoln].Value);
y0_1 = Convert.ToInt32(dgv1.Rows[irn - psa].Cells[pcoln].Value);
}
else
{
y0 = dgv[irn, pcoln];
y0_1 = dgv[irn - psa, pcoln];
}
int px = irn*xdot;
int px_1 = (irn - psa)*xdot;
int py0 = ph / gline[gsel].baseL - (int)((double)y0 * yscale);
int py0_1 = ph / gline[gsel].baseL - (int)((double)y0_1 * yscale);
// g1.DrawLine(Pens.Blue, px, py0, px - 1, py0_1);
g1.DrawLine(p, px, py0, px_1, py0_1);
Color c = samples[gsel];
if (CKarry[gsel].Checked == true) { g1.FillEllipse(b1, px, py0, 5, 5); }
//Debug.Print("itow0="+itow0.ToString()+"px=" + px.ToString()+"py0="+py0.ToString()+"px_1="+px_1.ToString()+"py0_1="+py0_1.ToString());
}
}
}
}
}
private int timeScale()
{
int dot=Convert.ToInt32(textBox10.Text);
// if (dot * dgv1.RowCount >bw)
if (dot * rowN > bw)
{
//dot = (int)(bw / dgv1.RowCount);
dot = (int)(bw /rowN);
if (dot == 0) { dot = 1; }
}
return dot;
}
private void hScrollBar1_Scroll(object sender, ScrollEventArgs e)
{
int cx = hScrollBar1.Value;
int pW = pictureBox1.Width;
int dot = Convert.ToInt32(textBox10.Text);
int posn = (int)cx / dot;
textBox3.Text = posn.ToString();//最終端の行No
int xdot = timeScale();
int rcx = (int)((cx - pW / 2) / xdot);
textBox13.Text="hscroll:="+cx.ToString()+"pW="+pW.ToString()+"dot="+dot.ToString()+"posn="+posn.ToString()+"xdot="+xdot.ToString()+"rcx="+rcx.ToString();
sourceCut(cx);
//----------センターカーソルのY値読み込み　表示--------------------------------------------------------
string g0s, g1s, g2s, g3s, g4s, g5s;
if (checkBox1.Checked == true)
{
g0s = (Convert.ToDouble(dgv1.Rows[rcx].Cells[gline[0].colN].Value) / gline[0].uscale).ToString();
g1s = (Convert.ToDouble(dgv1.Rows[rcx].Cells[gline[1].colN].Value) / gline[1].uscale).ToString();
g2s = (Convert.ToDouble(dgv1.Rows[rcx].Cells[gline[2].colN].Value) / gline[2].uscale).ToString();
g3s = (Convert.ToDouble(dgv1.Rows[rcx].Cells[gline[3].colN].Value) / gline[3].uscale).ToString();
g4s = (Convert.ToDouble(dgv1.Rows[rcx].Cells[gline[4].colN].Value) / gline[4].uscale).ToString();
g5s = (Convert.ToDouble(dgv1.Rows[rcx].Cells[gline[5].colN].Value) / gline[5].uscale).ToString();
}
else
{
g0s = Convert.ToDouble(dgv[rcx,gline[0].colN] / gline[0].uscale).ToString();
g1s = Convert.ToDouble(dgv[rcx,gline[1].colN] / gline[1].uscale).ToString();
g2s = Convert.ToDouble(dgv[rcx,gline[2].colN] / gline[2].uscale).ToString();
g3s = Convert.ToDouble(dgv[rcx,gline[3].colN] / gline[3].uscale).ToString();
g4s = Convert.ToDouble(dgv[rcx,gline[4].colN]/ gline[4].uscale).ToString();
g5s = Convert.ToDouble(dgv[rcx,gline[5].colN]/ gline[5].uscale).ToString();
}
if (gline[0].available == true && cx>pW/2) { textBox4.Text = g0s; }
if (gline[1].available == true && cx > pW / 2) { textBox5.Text =g1s; }
if (gline[2].available == true && cx > pW / 2) { textBox6.Text = g2s; }
if (gline[3].available == true && cx > pW / 2) { textBox7.Text = g3s; }
if (gline[4].available == true && cx > pW / 2) { textBox8.Text = g4s; }
if (gline[5].available == true && cx > pW / 2) { textBox9.Text = g5s; }
}
// soukrceBitamapを切り取る　XYPLOTと同期する場合は、comboBox7の値で同期
private void sourceCut(int cx)//最終端cx位置でカット
{
Bitmap p4Bitmap = new Bitmap(740,200);
Graphics g2 = Graphics.FromImage(trimmedBitmap);
g2.Clear(Color.Black);
Graphics g4 = Graphics.FromImage(p4Bitmap);
//----------Cut範囲選択--------------------------------
int startX = 0;
int pW = 1000;
int crange = 1000;
if(comboBox7.SelectedIndex>=0 && comboBox7.SelectedIndex<comboBox7.Items.Count-1)//blocknのスタート番号　
{
pW = blen;
blockn = comboBox7.SelectedIndex + 1;
startX = dbk[blockn].startRow;
}
else if(comboBox7.SelectedIndex== comboBox7.Items.Count - 1)//最終INDEXの場合は全データ切取り
{
pW = rowN;
blockn = comboBox7.SelectedIndex + 1;
startX = dbk[blockn].startRow;
}
else//comboBox7が選択されてない通常の時系列解析専用グラフ
{
pW = 1000;// 1000;//ソース切り取り幅をブロック長にする
if (cx > pW)
{
startX = cx - pW;
}
else
{
startX = 0;
}
}
if (checkBox10.Checked == true)
{
pictureBox1.Visible = true;
}
else
{
pictureBox1.Visible = false;
}
Rectangle srcRect = new Rectangle(startX, 0, pW, 500);
//Rectangle desRect = new Rectangle(0, 0, pW, 500);
Rectangle desRect = new Rectangle(0, 0, 1000, 500);
g2.DrawImage(sourceBitmap, desRect, srcRect, GraphicsUnit.Pixel);
//文字列を表示する範囲を指定する
RectangleF rect = new RectangleF(10, 10, 160, 100);
//rectの四角を描く
g2.FillRectangle(Brushes.Black, rect);
//フォントオブジェクトの作成
Font fnt = new Font("MS UI Gothic", 16);
//文字列を位置(0,0)、青色で表示
Debug.Print("sourceCut:pointrowN=" + pointrowN.ToString("D"));
g2.DrawString("rowN="+pointrowN.ToString("D"), fnt, Brushes.White, rect);
//Curosor value
int cval = pointrowN - dbk[blockn].startRow;
int pval =(int) pictureBox1.Width*cval/blen;
//Center Cursor
Pen p = new Pen(Color.White, 2);
g2.DrawLine(p,pval, 0,pval, 500);
Debug.Print("cval="+cval.ToString()+",pval="+pval.ToString());
pictureBox1.Image = trimmedBitmap;
// pictureBox4
Rectangle desRect4 = new Rectangle(0, 0, pictureBox4.Width, pictureBox4.Height);
g4.DrawImage(trimmedBitmap, desRect4, desRect, GraphicsUnit.Pixel);
//時間軸10等分　Y軸2等分
int xdiv = (int)(pictureBox4.Width / 10);
int ydiv = (int)(pictureBox4.Height / 2);
//時間軸目盛り
int it;
Pen p1 = new Pen(Color.LawnGreen,1);
p1.DashStyle = DashStyle.Dash;
for (it = 0; it < 10; it++)//x
{
g4.DrawLine(p1, it * xdiv, 0, it * xdiv, pictureBox4.Height);
}
for (it = 0; it <3; it++)//x
{
g4.DrawLine(p1, 0,it * ydiv, pictureBox4.Width,it * ydiv );
}
//time div 表示
int timdiv = (int)((blen * 0.02) / 10);
g4.DrawString(timdiv.ToString()+"sec/div", fnt, Brushes.White, 0, 0);
pictureBox4.Image = p4Bitmap;//pictureBox4 目盛り
}
//*******************************************************************************************************
//------xybitmap picturebox2 ----------------------------------------
private void xyplot()
{
Graphics srcxy = Graphics.FromImage(xyBitmap);
Graphics srcsxy = Graphics.FromImage(xysBitmap);
Graphics desxy = Graphics.FromImage(p2Bitmap);
srcxy.Clear(Color.Black);
srcsxy.Clear(Color.Black);
int ix, irow;
int px = 0;
int py = 0;
//prown 　クリック座標逆引き配列 宣言
prownx = new int[blen];
prowny = new int[blen];
// int pic2w = 300;
// int PIC2H = 300;
int bitxyw = xysize;// 3000;
int bitxyh = xysize;// 3000;
int nutralflag = 0;
long valx, valy;
long valxi, valyi;
//
blockn_1 = blockn;
blockn = comboBox7.SelectedIndex + 1;//blen個毎にブロック切り替え
Debug.Print("XYPLOT:blockn=" + blockn.ToString() + "dbk[].minlon=" + dbk[blockn].minlon.ToString() + "dbk[].minlat=" + dbk[blockn].minlat.ToString());
// int startrow = (blockn - 2) * blen;
//---------------Nutral Point Array set Block指定のみ----------------------------------------------------
if (blockn < comboBox7.Items.Count)
{
for (irow = dbk[blockn].startRow; irow < dbk[blockn].endRow-2; irow++)//dgv1.RowCount - 3; irow++)
{
int ni = irow - dbk[blockn].startRow;
long sa = dgv[irow+1, 3] - dgv[irow , 3];
long sa_1= dgv[irow+2, 3] - dgv[irow +1, 3];
if (sa*sa_1<0 && irow > 2)//headmotの極値変化
{
dbk[blockn].nutralN[ni] = 1;//ニポイントを１
//Debug.Print("Nutral ON:headMot="+dgv[irow,3].ToString()+"irow=" + irow.ToString() + ",dbk[blockn].nutralN[" + ni.ToString() + "]=" + dbk[blockn].nutralN[ni].ToString());
}
else if (irow > 2 )
{
dbk[blockn].nutralN[ni] = 0;//ニュートラルポイントでない０
// Debug.Print("Nutral Off:headMot="+dgv[irow,3].ToString()+"irow=" + irow.ToString() + ",dbk[blockn].nutralN[" + ni.ToString() + "]=" + dbk[blockn].nutralN[ni].ToString());
}
}
}
//-------------------------------------------------------------------------------------------------
// if (blockn == comboBox7.Items.Count)//all
//{
// startrow = 1;
// }
//
lonW = dbk[blockn].lonW; //maxlon[blockn] - minlon[blockn];
latH = dbk[blockn].latH;//maxlat[blockn] - minlat[blockn];
//Debug.Print("lonW=" + lonW.ToString() + ",latH=" + latH.ToString());
//------------------------ソースxybitmap へ縮小プロット---------------------------------
scalex = (double)(lonW * 1.1 / bitxyw);//lonWは、xysize 20000全幅cm/dot
scaley = (double)(latH * 1.1 / bitxyh);//latHは全高cm/dot
if (scalex > scaley) { scale0 = scalex; }//大きいスケールを採用
if (scalex < scaley) { scale0 = scaley; }
//textBox14.Text = scale0.ToString();
label3.Text ="縦="+(latH/100).ToString()+"m,横="+(lonW/100).ToString()+ "m, 縮尺"+scale0.ToString("n2")+"cm/dot";
//int endblock = 0;
//if (rowN > (blockn - 1) * blen) //最後のブロックでない場合のエンド行No
//{
// endblock = (blockn - 1) * blen;
//}
//else
//{
// endblock = rowN - 2;
//}
for (irow = dbk[blockn].startRow; irow < dbk[blockn].endRow; irow++)//dgv1.RowCount - 3; irow++)
{
if (dgv[irow, 4] > 0 && dgv[irow, 5] > 0)
{
if (checkBox1.Checked == true)
{
valx = Convert.ToInt32(dgv1.Rows[irow].Cells[4].Value);//lon
valy = Convert.ToInt32(dgv1.Rows[irow].Cells[5].Value);//lat
}
else
{
valx = dgv[irow, 4];//Convert.ToInt32(dgv1.Rows[irow].Cells[4].Value);//lon
valy = dgv[irow, 5];//Convert.ToInt32(dgv1.Rows[irow].Cells[5].Value);//lat
}
valxi = valx - dbk[blockn].minlon;
valyi = valy - dbk[blockn].minlat;
px_1 = px;
px = Convert.ToInt32((double)valxi / scale0);
py_1 = py;
py = Convert.ToInt32((double)valyi / scale0);
//prown 逆弾き代入
if (blockn < comboBox7.Items.Count)//AllBlock 以外
{
prownx[irow-dbk[blockn].startRow] = px;
prowny[irow-dbk[blockn].startRow] = py;
}
//
// All block での色分け
Color cxy;
if(blockn>alln)
{
a = Convert.ToInt32(Math.Ceiling((double)irow / blen));
cxy = samples[a-1];
}
else
{
cxy = samples[blockn - 1];
}
//
if (checkBox11.Checked == true)
{
// Pen p = new Pen(Color.LawnGreen, 2);
Pen p = new Pen(cxy, 4);
srcxy.DrawLine(p, px, py, px_1, py_1);
Pen p1= new Pen(cxy, 1);
srcsxy.DrawLine(p1, px, py, px_1, py_1);//拡大用ソース
}
// Brush b1 = new SolidBrush(samples[blockn - 1]);
Brush b1 = new SolidBrush(cxy);
Brush b2 = new SolidBrush(Color.White);
//Nutral Point White
if (blockn < comboBox7.Items.Count)//AllBlock 以外
{
//Debug.Print("colorWhite:irow=" + irow.ToString() + "nutralN=" + dbk[blockn].nutralN[irow - dbk[blockn].startRow].ToString());
if (dbk[blockn].nutralN[irow - dbk[blockn].startRow] == 1)
{
nutralflag = 1;
}
}
// Debug.Print("irow=" + irow.ToString() + ",px=" + px.ToString() + "py=" + py.ToString());
if (dgv[irow, 1] % 100 == 0)//F9P 100msec
{
int diam = 16;
int pxd = px - diam / 2;
int pyd = py - diam / 2;
if (nutralflag == 1) { b1 = b2; }
srcxy.FillEllipse(b1, pxd, pyd, 24, 24);
srcsxy.FillEllipse(b1, pxd, pyd, 4, 4);
nutralflag = 0;
}
}
}
// Debug.Print("irow="+irow.otring()+"px,py="+px.ToString() +","+ py.ToString());
//縮小表示　3000x3000を300x300へ縮小表示-------------------------------------------------
Rectangle srcrect = new Rectangle(0, 0, xysize, xysize);
Rectangle desrect = new Rectangle(0, 0, pic2w, pic2h);
desxy.DrawImage(xyBitmap, desrect, srcrect, GraphicsUnit.Pixel);
//p2sBitmap = p2Bitmap;
pictureBox2.Image = p2Bitmap;
Debug.Print("scale0=" + scale0.ToString() + "px,py=" + px.ToString() + "," + py.ToString());
}//Picturebox2 xyplot******************************************************************************************************
//picturebox2 Mousepoint Cut ===========================================
private void xycut(double magni)
{
int cutcenterx = cp2x*(int)(xysize/pic2w);//cp2は、クリック関数内で計算してあるソースビットマップの座標に変換
int cutcentery = cp2y*(int)(xysize/pic2h);//
//int lefttopx = cutcenterx - pic2w/2;
//int lefttopy= cutcentery - pic2h/2;
//magniでカット面積縮小
lefttopx = (int)(cutcenterx - (pic3w / 2)/magni);//切り取り四角座標計算
lefttopy =(int)(cutcentery -( pic3h / 2)/magni);
// Debug.Print("lefttopx=" + lefttopx.ToString() + "lefttopy=" + lefttopy.ToString());
// Graphics g2 = Graphics.FromImage(p2Bitmap);
Graphics g3 = Graphics.FromImage(p3Bitmap);
g3.Clear(Color.Black);
// magni = 10;
if (magni == 0) { magni = 1; }
int magniw = Convert.ToInt32((double)pic3w/magni );
int magnih = Convert.ToInt32((double)pic3h/magni );
Rectangle srcxyRect = new Rectangle(lefttopx, lefttopy, magniw,magnih);
Rectangle desxyRect = new Rectangle(0, 0,pic3w, pic3h);
g3.DrawImage(xysBitmap, desxyRect, srcxyRect, GraphicsUnit.Pixel);
//p2Bitmapへクリック枠描画
Pen p = new Pen(Color.White, 1);
//位置(10, 20)に100x80の長方形を描く
//int p2Topx = cp2x - 10;
// int p2Topy = cp2y - 10;
// g2.DrawRectangle(p, p2Topx, p2Topy, p2Topx+20, p2Topy+20);
//---------------縮尺目盛り------------
Brush b2 = new SolidBrush(Color.White);
g3.FillEllipse(b2, 10,10, 10, 10);
g3.FillEllipse(b2, 110, 10, 10, 10);
Pen p2 = new Pen(Color.White, 2);
g3.DrawLine(p2, 15, 15, 115, 15);
string shukumoji = (scale0 / magni).ToString("n1")+"m";
//フォントオブジェクトの作成
Font fnt = new Font("MS UI Gothic", 16);
//文字列を位置(0,0)、青色で表示
g3.DrawString(shukumoji, fnt, Brushes.White, 130,8);
pictureBox3.Image=p3Bitmap;
//----------クリック枠表示-------------------
if(wakuflag==1)
{
p2wBitmap = new Bitmap(p2Bitmap);//p2Bitmapをコピー
Graphics g2w = Graphics.FromImage(p2wBitmap);
//g2w.Clear(Color.Black);
double scale_xy2 = (double)( xyBitmap.Width/p2Bitmap.Width );
int wakuw =(int)( magniw / scale_xy2);
int wakuh= (int)(magnih / scale_xy2);
int wakutopx = (int)(cp2x - wakuw / 2);
int wakutopy = (int)(cp2y - wakuh / 2);
g2w.DrawRectangle(p,wakutopx,wakutopy,wakuw,wakuh);
pictureBox2.Image = p2wBitmap;
}
}
//pictureBox1 iClear
private void sourceBitmap_clear()
{
Graphics g4 = Graphics.FromImage(sourceBitmap);
g4.Clear(Color.Black);
pictureBox1.Image = sourceBitmap;
}
private void label1_Click(object sender, EventArgs e)
{
}
private void dgv1_CellContentClick(object sender, DataGridViewCellEventArgs e)
{
}
private void checkBox10_CheckedChanged(object sender, EventArgs e)
{
if (checkBox10.Checked == true)
{
pictureBox1.Visible = true;
pictureBox2.Visible = false;
pictureBox3.Visible =true;
sourceCut(1000);
}
else
{
pictureBox1.Visible = false;
pictureBox2.Visible = true;
pictureBox3.Visible = true;
}
}
private void checkBox12_CheckedChanged(object sender, EventArgs e)
{
if(checkBox12.Checked==true)
{
pictureBox1.Visible = false;
pictureBox2.Visible = true;
pictureBox3.Visible = true;
pictureBox4.Visible = true;
}
else
{
pictureBox4.Visible = false;
}
}
private void comboBox7_SelectedIndexChanged(object sender, EventArgs e)
{
int cno = comboBox7.SelectedIndex;
if (cno < 6)
{
comboBox7.BackColor = samples[cno];//= Color.FromArgb(86, 61, 124))
}
/*
comboBox7.Items.Add("0");
comboBox7.Items.Add("1");
comboBox7.Items.Add("2");
comboBox7.Items.Add("3");
comboBox7.Items.Add("4");
comboBox7.Items.Add("5");
comboBox7.Items.Add("All");
comboBox7.SelectedIndex = 6;
*/
}
private void pictureBox2_Click(object sender, EventArgs e)//pictureBox2 拡大位置指定クリック
{
// ポイント枠専用Bitmapを作る
wakuflag = 1;//枠専用描画する
//画面座標でマウスポインタの位置を取得する
System.Drawing.Point sp = System.Windows.Forms.Cursor.Position;
//画面座標をクライアント座標に変換する
System.Drawing.Point cp = this.PointToClient(sp);
//X座標を取得する
int x = cp.X;
//Y座標を取得する
int y = cp.Y;
int p2top=pictureBox2.Top;
int p2left= pictureBox2.Left;
cp2x = cp.X - p2left;//pirctureBox2のマウスポイント位置をxycut()へ渡す
cp2y = cp.Y - p2top;//
label6.Text = "cpx=" + cp2x.ToString() + "cpy=" + cp2y.ToString();
wheelVal = Convert.ToDouble(label5.Text);//クリック Wheel倍率がlabel5に書いてある
xycut(wheelVal);
}
private void pictureBox3_Click(object sender, EventArgs e)// pictureBox3をクリックした時の逆引き計算機能
{
Graphics g3 = Graphics.FromImage(p3Bitmap);
//画面座標でマウスポインタの位置を取得する
System.Drawing.Point sp = System.Windows.Forms.Cursor.Position;
//画面座標をクライアント座標に変換する
System.Drawing.Point cp = this.PointToClient(sp);
//X座標を取得する
int x = cp.X;
//Y座標を取得する
int y = cp.Y;
int p3top = pictureBox3.Top;
int p3left = pictureBox3.Left;
int cp3x = cp.X - p3left;//
int cp3y = cp.Y - p3top;//
double rcp3x = (double)cp3x / pic3w;//座標を比率で求める
double rcp3y = (double)cp3y / pic3h;
//
double magni= Convert.ToDouble(label5.Text);//クリック Wheel倍率がlabel5に書いてある
int src_cp3x = (int)(pic3w / magni * rcp3x);
int src_cp3y = (int)(pic3h / magni * rcp3y);
int src_px = src_cp3x + lefttopx;
int src_py = src_cp3y + lefttopy;
Debug.Print("src_px=" + src_px.ToString() + ",src_py=" + src_py.ToString());
//逆引きサーチ
int irn,ix, iy;
double dis=0;
double dismin = 10000;
double[] disminAry = new double[10];
int disno=0;
int irowcountx = 0;
int irowcounty = 0;
for (irn = 0; irn < blen; irn ++)
{
double s = (src_px - prownx[irn]) * (src_px - prownx[irn]) + (src_py - prowny[irn]) * (src_py - prowny[irn]);
dis =Math.Sqrt(s);
if (dis < dismin)
{
dismin= dis;
disno = irn;
}
}
pointrowN = disno + dbk[blockn].startRow;
Debug.Print("dismin=" + dismin.ToString() + "pointrowN=" + pointrowN.ToString());
Font fnt = new Font("MS UI Gothic", 15);
//文字列を表示する範囲を指定する
RectangleF rect = new RectangleF(10,28, 150, 100);
//rectの四角を描く
g3.FillRectangle(Brushes.Black, rect);
//dgv　ブロックNo　行番号
string gyon="rowN="+pointrowN.ToString("D");
g3.DrawString(gyon, fnt, Brushes.White, rect);
//itow
string itows ="itow=" +dgv[pointrowN, 1].ToString();
g3.DrawString(itows, fnt, Brushes.White, 10,44);
//gSpeed
float gspeedkph = (float)dgv[pointrowN, 2] / 1000000 * 3600;
float gspeedmps= (float)dgv[pointrowN, 2] / 1000;
string speeds = "gSpeed=" + ((float)dgv[pointrowN, 2] / 100000).ToString();
g3.DrawString(gspeedkph.ToString("F2")+" km/h", fnt, Brushes.White, 10,64);
g3.DrawString(gspeedmps.ToString("F2")+" m/sec", fnt, Brushes.White, 10, 84);
pictureBox3.Image = p3Bitmap;
sourceCut(1000);//time base graph
}
private void button6_Click(object sender, EventArgs e)
{
dgvsave();
}
}
}
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment