public DSP(int num)
{
plan = new FFTPlan(num);
dataIn=new float[num*2];
dataOut=new float[num*2];
this.FFTNUM = num;
}
public FormRawData()
{
InitializeComponent();
this.rawCurveGroup = this.chart.AddNewGroup();
this.rawCurveGroup.XAxes.MaxScale = 100000000L;
this.rawCurveGroup.XAxes.MinScale = 400;
this.rawCurveGroup.XAxes.SetScale(100000);
this.rawCurveGroup.XAxes.SetOrgTime(ChartGraph.DateTime2ChartTime(DateTime.Now), 0);
this.rawCurveGroup.CursorType = CurveCursorType.CURSOR_CROSSLINE;
rawCurveGroup.XAxes.XAxesMode = XAxesMode.Relative;
this.rawCurveGroup.DrawPointFlagXAxesScale = 500;
this.freqCurveGroup = this.chart1.AddNewGroup();
this.freqCurveGroup.XAxes.MaxScale = 100000000L;
this.freqCurveGroup.XAxes.MinScale = 100;
this.freqCurveGroup.XAxes.SetScale(100000);
this.freqCurveGroup.XAxes.SetOrgTime(ChartGraph.DateTime2ChartTime(DateTime.Now), 0);
this.freqCurveGroup.CursorType = CurveCursorType.CURSOR_CROSSLINE;
freqCurveGroup.XAxes.XAxesMode = XAxesMode.Relative;
this.freqCurveGroup.DrawPointFlagXAxesScale = 500;
fftPlan = new FFTPlan(secNum * 8000);
fftIn = new float[secNum * 8000 * 2];
fftOut = new float[secNum * 8000 * 2];
}
private void QueryData()
{
if (selChannel == null)
{
return;
}
int selIndex = comboBoxEdit1.SelectedIndex;
if (selIndex < 0)
{
return;
}
DateTime timeSel = listTimes[selIndex];
timeQuery = timeSel.AddSeconds((timeEdit1.Time - timeEdit1.Time.Date).TotalSeconds);
if (timeQuery < selChannel.File.BeginTime)
{
MessageBox.Show("查询时间小于记录开始时间!", "查询", MessageBoxButtons.OK, MessageBoxIcon.Warning);
return;
}
if (timeQuery > selChannel.File.EndTime)
{
MessageBox.Show("查询时间大于记录开始时间!", "查询", MessageBoxButtons.OK, MessageBoxIcon.Warning);
return;
}
int sec = (int)((timeQuery - selChannel.File.BeginTime).TotalSeconds);
trackBarControl1.ValueChanged -= new EventHandler(trackBarControl1_ValueChanged);
trackBarControl1.Value = sec;
trackBarControl1.ValueChanged += new EventHandler(trackBarControl1_ValueChanged);
float[] data = selChannel.File.GetData(selChannel.Channel - 1, timeQuery, secNum);
rawCurveGroup.ClearChartObject();
freqCurveGroup.ClearChartObject();
this.rawCurveGroup.XAxes.SetOrgTime(ChartGraph.DateTime2ChartTime(timeQuery), 0);
this.freqCurveGroup.XAxes.SetOrgTime(ChartGraph.DateTime2ChartTime(timeQuery), 0);
//幅度谱
LineArea laAmpl = new LineArea(chart, "原始波形", false);
laAmpl.YAxes.YAxesMin = 0;
laAmpl.YAxes.YAxesMax = 200;
LineCurve lcAmpl = new LineCurve(chart, "原始波形", 0);
lcAmpl.LineColor = Color.Lime;
laAmpl.AddLine(lcAmpl);
//lc.YAxes.Mode = YAxesMode.Manual;
lcAmpl.YAxes.YAxesMin = 0;
lcAmpl.YAxes.YAxesMax = 100;
if (data != null)
{
long startTm = ChartGraph.DateTime2ChartTime(timeQuery);
for (int j = 0; j < data.Length; j++)
{
long tm = startTm + j * 1000000L / 8000;
// var tm = timeQuery.AddMilliseconds(j / 8.0);
lcAmpl.AddPoint(new LinePoint(tm, data[j]));
}
}
//频率谱
LineArea laFreq = new LineArea(chart1, "频率谱", false);
laFreq.YAxes.YAxesMin = 0;
laFreq.YAxes.YAxesMax = 200;
laFreq.XFreqScale = 8000f / (secNum * 1000000);
LineCurve lcFreq = new LineCurve(chart1, "频率谱", 0);
lcFreq.LineColor = Color.Red;
laFreq.AddLine(lcFreq);
lcFreq.YAxes.Mode = YAxesMode.Manual;
lcFreq.YAxes.YAxesMin = -1;
lcFreq.YAxes.YAxesMax = 15;
if (data != null)
{
if (fftPlan.FFTNum != secNum * 8000)
{
fftPlan.Dispose();
fftPlan = new FFTPlan(secNum * 8000);
fftIn = new float[secNum * 16000];
fftOut = new float[secNum * 16000];
}
for (int i = 0; i < data.Length; i++)
{
fftIn[i * 2] = data[i];
fftIn[i * 2 + 1] = 0;
}
fftPlan.FFTForward(fftIn, fftOut);
long startTm = ChartGraph.DateTime2ChartTime(timeQuery);
float maxAmpl = 0;
for (int j = 0; j < data.Length / 2; j++)
{
long tm = startTm + j * 1000000L / 8000;
// var tm = timeQuery.AddMilliseconds(j / 8.0);
float amplVal = 0;
if (j > 2) //不显示直流
{
amplVal = (float)(Math.Sqrt(fftOut[2 * j] * fftOut[2 * j] + fftOut[2 * j + 1] * fftOut[2 * j + 1]) * 2 / (8000 * secNum));
}
if (amplVal > maxAmpl)
{
maxAmpl = amplVal;
}
lcFreq.AddPoint(new LinePoint(tm, amplVal));
}
lcFreq.YAxes.YAxesMax = maxAmpl * 1.2f;
}
rawCurveGroup.AddChartObject(laAmpl);
freqCurveGroup.AddChartObject(laFreq);
chart.Draw();
chart1.Draw();
}
private void ProcDSP()
{
DSPUtil util = new DSPUtil();
FFTPlan fftPlan = null;
float[] data1 = null;
float[] data2 = null;
float[] fftData = null;
float[] dataSpectrum = null;
int PeakNum = 6;
float[] ypDiff = new float[PeakNum - 1];
float[] peakVal = new float[PeakNum];
int[] peakIndexLeft = new int[PeakNum];
int[] peakIndexLeftTmp = new int[PeakNum];
int[] peakIndexRight = new int[PeakNum];
float[] dcacAmpl = new float[2];
float[] amplDense = new float[250];
// float[] amplDenseDC = new float[25];
float dcAmpl = 0;
float acAmpl = 0;
float prevCarrier = -1;
float prevLow = -1;
int diffCnt = 0;
float carrierFreq = 0;
float lowFreq = 0;
float standard = 0;
SignalArgs args;
List <float> curveList = new List <float>();
bool curveStart = false;
float[] ypList = new float[] { 8.5f, 9.0f, 9.5f, 11.0f, 12.5f, 13.5f, 15.0f, 16.5f, 17.5f, 18.5f, 20.0f, 21.5f, 22.5f, 23.5f, 24.5f, 26.0f };
Queue <float> queueACCurve = new Queue <float>();
int maxCurveCnt = 0;
int MAXPT = 40 * 25;
int PRENUM = 5;
this.adBlock = new ADBlock(SampleRate, SampleRate);
try
{
while (true)
{
float[] adData = adBlock.GetAdData(-1);
if (SignalArgsChanged == null)
{
eventDSP.Set();
continue;
}
if (adData == null)
{
continue;
}
if (DecodeCurve > 0) //计算道岔曲线 ，不计算载频和低频
{
int calCnt = (int)(1000 / this.TimeInterval);
int amplCnt = this.SampleRate / calCnt; //40ms一个点
for (int i = 0; i < calCnt; i++)
{
if (DecodeCurve == 1)
{
amplDense[i] = util.CalACAmpl(adData, i * amplCnt, amplCnt);
amplDense[i] = CalRealVal(amplDense[i], 50); //道岔电流都是交流50Hz
}
else if (DecodeCurve == 2)
{
amplDense[i] = util.CalDCAmpl(adData, i * amplCnt, amplCnt);
amplDense[i] = CalRealVal(amplDense[i], 0);
}
if (curveStart == false)
{
if (queueACCurve.Count >= PRENUM)
{
float[] prevVals = queueACCurve.ToArray();
for (int j = 0; j < prevVals.Length - 1; j++)
{
if (prevVals[j] > 0.001f)
{
float rate = (prevVals[prevVals.Length - 1] - prevVals[j]) / prevVals[j];
if (rate > 5)
{
curveStart = true;
curveList.AddRange(prevVals);
maxCurveCnt = MAXPT;
break;
}
}
}
}
}
else
{
curveList.Add(amplDense[i]);
if (amplDense[i] < 0.06f)
{
if (maxCurveCnt >= MAXPT)
{
maxCurveCnt = curveList.Count + 5;
}
}
if (curveList.Count >= maxCurveCnt) //最大40秒
{
args = new SignalArgs(recordFile.TimeExport.AddMilliseconds(-1 * this.TimeInterval * curveList.Count + i * 1000f / calCnt), curveList.ToArray());
SignalArgsChanged(this, args);
curveStart = false;
maxCurveCnt = 0;
curveList.Clear();
queueACCurve.Clear();
}
}
if (queueACCurve.Count >= PRENUM)
{
queueACCurve.Dequeue();
}
queueACCurve.Enqueue(amplDense[i]);
}
eventDSP.Set();
continue;
}
if (fftPlan == null)
{
fftPlan = new FFTPlan(SampleRate);
data1 = new float[SampleRate * 2];
data2 = new float[SampleRate * 2];
fftData = new float[SampleRate * 2];
dataSpectrum = new float[SampleRate];
}
//将实数变为复数
for (int i = 0; i < adData.Length; i++)
{
data1[i * 2] = adData[i];
data1[i * 2 + 1] = 0;
}
fftPlan.FFTForward(data1, fftData);
Array.Copy(fftData, data2, data2.Length);
//计算频谱
int spectrumLen = adData.Length / 2;
for (int i = 0; i < spectrumLen; i++)
{
dataSpectrum[i] = (float)Math.Sqrt(data2[i * 2] * data2[i * 2] + data2[i * 2 + 1] * data2[i * 2 + 1]);
}
//计算交直流幅度
util.CalDCACAmpl(adData, 0, this.SampleRate, dcacAmpl);
dcAmpl = CalRealVal(dcacAmpl[0], 0);
acAmpl = CalRealVal(dcacAmpl[1], 0);
int ignoreLow = DecodeFM?400: 5;
int ignoreHigh = DecodeFM ? 3000 : this.SampleRate / 2;
util.FindComplexPeaks(data2, ignoreLow, ignoreHigh, peakVal, peakIndexLeft); //忽略直流信息
// int freqCenter= util.CalFreqCenter(dataSpectrum, 400);
if (peakIndexLeft[0] < 0)
{
args = new SignalArgs(recordFile.TimeExport, dcAmpl, acAmpl, 0, 0);
SignalArgsChanged(this, args);
eventDSP.Set();
continue; //不存在极点
}
float freq = peakIndexLeft[0];
acAmpl = CalAmplByFreq(fftData, (int)freq);
acAmpl = CalRealVal(acAmpl, freq);
if (DecodeFM == false)
{
args = new SignalArgs(recordFile.TimeExport, dcAmpl, acAmpl, 0, 0);
SignalArgsChanged(this, args);
eventDSP.Set();
continue;
}
if (DecodeFM)
{
if (acAmpl < 0.1)
{
eventDSP.Set();
continue;
}
bool matchYP = true;
bool matchUM71 = true;
float freqShift = 0;
int underSampleCount = 1;
for (int i = 0; i < peakIndexLeft.Length; i++)
{
if ((peakIndexLeft[i] < 1600 - 200) || (peakIndexLeft[i] > 2600 + 200))
{
matchUM71 = false;
}
if ((peakIndexLeft[i] < 550 - 100) || (peakIndexLeft[i] > 850 + 100))
{
matchYP = false;
}
}
if ((matchYP == false) && (matchUM71 == false))
{
carrierFreq = peakIndexLeft[0];
lowFreq = 0;
}
if (matchYP)
{
float tmpShiftDiff = float.MaxValue;
for (int i = 0; i < peakIndexLeft.Length - 2; i++)
{
for (int j = i + 1; j < peakIndexLeft.Length - 1; j++)
{
float tmpShift = (peakIndexLeft[i] + peakIndexLeft[j]) / 2f;
if (Math.Abs(tmpShift - 550) < tmpShiftDiff)
{
freqShift = tmpShift;
tmpShiftDiff = Math.Abs(tmpShift - 550);
}
if (Math.Abs(tmpShift - 650) < tmpShiftDiff)
{
freqShift = tmpShift;
tmpShiftDiff = Math.Abs(tmpShift - 650);
}
if (Math.Abs(tmpShift - 750) < tmpShiftDiff)
{
freqShift = tmpShift;
tmpShiftDiff = Math.Abs(tmpShift - 750);
}
if (Math.Abs(tmpShift - 850) < tmpShiftDiff)
{
freqShift = tmpShift;
tmpShiftDiff = Math.Abs(tmpShift - 850);
}
}
}
util.FindComplexPeaks(data2, (int)freqShift, ignoreHigh, peakVal, peakIndexLeft);
standard = Math.Abs(peakIndexLeft[0] - peakIndexLeft[1]);
underSampleCount = 30;
}
if (matchUM71)
{
freqShift = peakIndexLeft[0] - 40;
underSampleCount = 40;
}
util.ShiftSignal(data1, freqShift, this.SampleRate); //频谱搬移
util.ComplexFilter(data1, data2); //滤波
util.UnderSample(data2, underSampleCount); //欠采样
fftPlan.FFTForward(data2, data1); //频谱分析
if (matchYP)
{
int signalLength = data1.Length / 2;
util.FindComplexPeaks(data1, 0, signalLength / 2, peakVal, peakIndexLeft);
float diffMinYp = 1.5f; //最大不能差1.5
lowFreq = -1;
for (int j = 0; j < peakIndexLeft.Length - 1; j++)
{
for (int k = j + 1; k < peakIndexLeft.Length; k++)
{
float tmpLow = Math.Abs(peakIndexLeft[k] - peakIndexLeft[j]) * 1f / underSampleCount;
if (tmpLow > 8 && tmpLow < 28)
{
if (Math.Abs(tmpLow - standard) < diffMinYp)
{
lowFreq = tmpLow;
diffMinYp = Math.Abs(tmpLow - standard);
}
}
}
if (lowFreq > 0)
{
break;
}
}
util.FindComplexPeaks(data1, signalLength / 2, signalLength, peakVal, peakIndexRight);
carrierFreq = freqShift;
}
if (matchUM71)
{
util.FindComplexPeaks(data1, peakVal, peakIndexLeft);
carrierFreq = freqShift + peakIndexLeft[0] * 1f / underSampleCount;
lowFreq = Math.Abs(peakIndexLeft[1] - peakIndexLeft[2]) / 2f / underSampleCount;
if (lowFreq < 9 || lowFreq > 31)
{
lowFreq = -1;
}
}
}
acAmpl = CalAmplByFreq(fftData, (int)carrierFreq);
acAmpl = CalRealVal(acAmpl, carrierFreq);
if (Math.Abs(carrierFreq - prevCarrier) > 10 || Math.Abs(lowFreq - prevLow) > 1)
{
diffCnt++;
if (diffCnt >= 2)
{
prevCarrier = carrierFreq;
prevLow = lowFreq;
diffCnt = 0;
}
else
{
carrierFreq = prevCarrier;
lowFreq = prevLow;
}
}
else
{
prevCarrier = carrierFreq;
prevLow = lowFreq;
diffCnt = 0;
}
args = new SignalArgs(recordFile.TimeExport, dcAmpl, acAmpl, carrierFreq, lowFreq);
SignalArgsChanged(this, args);
eventDSP.Set();
}
}
catch (Exception)
{
if (fftPlan != null)
{
fftPlan.Dispose();
}
}
}
