/// <summary> 手肘肩の角度 全開で2,3前後の値 </summary> private void GetAngleList() { InitParameter(); for (int i = 0; i < timeTable.Count; i++) { double angle = Caliculater.GetAngle(jointsList[i], anglePoint[0], anglePoint[1], anglePoint[2]); UpdateMaxMin(angle); datapointList[i] = new DataPoint(timeTable[i], angle); } UpdateView(); }
/// <summary> 角速度 </summary> private void GetAngularVelocityList() { InitParameter(); double angle0 = 0; datapointList[0] = new DataPoint(timeTable[0], 0); for (int i = 1; i < timeTable.Count; i++) { double angle = Caliculater.GetAngle(jointsList[i], anglePoint[0], anglePoint[1], anglePoint[2]); double aVelocity = (angle - angle0) / (timeTable[i] - timeTable[i - 1]); if (timeTable[i] < 2000) { aVelocity = 0; } UpdateMaxMin(aVelocity); datapointList[i] = new DataPoint(timeTable[i], aVelocity); angle0 = angle; } UpdateView(); }