//螺钉拧进拧出
private bool NingChu(DataRow program_row, string id, DataTable group_table, IList<IMotion> _motionList,
IList<IList<IMotion>> _complexMotionList){
Transform firstObj = null;
Transform firstObjParent = null;
List<Transform> parentList = new List<Transform>();
List<Transform> childList = new List<Transform>();
Transform screwTrans = null;
Transform screwTransParent = null;
bool isRight = true;
//Group Column
int groupColumn = IntConversion((string)program_row[3].ToString(), ref isRight) + 1;
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCGROUP", id) + "，螺钉拧出运动Group填写错误！");
}
return false;
}
//运动物体信息
string objName = "";
try{
objName = (string)group_table.Rows[0][groupColumn].ToString();
firstObj = GameObject.Find(objName).transform;
firstObjParent = firstObj.parent;
for (int i = 1; i < group_table.Rows.Count; i++)
{
objName = (string)group_table.Rows[i][groupColumn].ToString();
if(objName == "")
break;
Transform tempTrans = GameObject.Find(objName).transform;
childList.Add(tempTrans);
parentList.Add(tempTrans.parent);
}
}catch{
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCGROUP", id) + "，Group号对应的Group表填写有错误！");
}
return false;
}
//被拧物体
try{
screwTrans = GameObject.Find((string)program_row[4].ToString()).transform;
screwTransParent = screwTrans.parent;
}catch{
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCREFER", id) + "，被拧物体填写有错误！");
}
return false;
}
//扳手到螺钉距离
Vector3 disNCVec = Vector3Conversion((string)program_row[5].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCDIS", id) + "，拧的距离填写有错误！");
}
return false;
}
float disNC = disNCVec.magnitude;
//旋转轴
Vector3 rotateAxis = Vector3Conversion((string)program_row[6].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCAXIS", id) + "，拧的旋转轴填写有错误！");
}
return false;
}
//螺钉拧出的距离
Vector3 disNCLVec = Vector3Conversion((string)program_row[7].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCLDIS", id) + "，拧出来的距离填写有错误！");
}
return false;
}
float disNCL = disNCLVec.magnitude;
//移动速度
float moveSpeed = MotionPara.toolMoveSpeed;
if(program_row.Table.Columns.Count > 8){
if((string)program_row[8].ToString() != ""){
moveSpeed = FloatConversion((string)program_row[8].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCSPEED", id) + "，自定义速度填写有错误！");
}
return false;
}
}
}
//扳手移进时的坐标轴，如果要通用化，请修改这里
Vector3 moveVecUnit = new Vector3(0f, -1.0f, 0f);
if (program_row.Table.Columns.Count > 9)
{
if ((string)program_row[9].ToString() != "")
{
moveVecUnit = Vector3Conversion((string)program_row[9].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCBANSHOU", id) + "，自定义扳手坐标轴填写有错误！");
}
return false;
}
}
}
//参考空物体
GameObject emptyRefer = new GameObject();
emptyRefer.name = "NingChu_empty-" + id;
//开始生成类数据
IList<IMotion> tempMotionList = new List<IMotion>();
//首次移进 New---Class
BasicMotion _simpleMotion = new BasicMotion();
_simpleMotion.State = CurrentState.Active;
_simpleMotion.CurrentMotion = MotionType.MoveOnly;
_simpleMotion.StartPos = firstObj.position;
_simpleMotion.StartEurler = firstObj.eulerAngles;
emptyRefer.transform.position = firstObj.position;
emptyRefer.transform.eulerAngles = firstObj.eulerAngles;
_simpleMotion.ParentTrans = firstObj;
_simpleMotion.ListCopy(childList, parentList);
Vector3 motionVec = moveVecUnit * disNC;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion.EndPos = emptyRefer.transform.position;
_simpleMotion.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion.SpeedVector = motionVec / _simpleMotion.StandardTime;
_simpleMotion.EndTime = _simpleMotion.StandardTime / _simpleMotion.SpeedRate;
tempMotionList.Add(_simpleMotion);
//拧出 New---Class
BasicMotion _simpleMotion2 = new BasicMotion();
_simpleMotion2.State = CurrentState.Future;
_simpleMotion2.CurrentMotion = MotionType.MoveRotateSingle;
_simpleMotion2.ParentTrans = screwTrans;
_simpleMotion2.ListCopy(childList, parentList);
_simpleMotion2.ChildList.Add(firstObj);
_simpleMotion2.ParentList.Add(firstObjParent);
_simpleMotion2.ChildList.Add(screwTrans);
_simpleMotion2.ParentList.Add(screwTransParent);
GameObject emptyObj = new GameObject();
emptyObj.name = "move-rotate_empty-" + id + "-ningchu";
emptyObj.transform.position = screwTrans.position;
emptyObj.transform.eulerAngles = screwTrans.eulerAngles;
//将emptyRefer当做扳手用于后面过程定位
emptyRefer.transform.parent = emptyObj.transform;
_simpleMotion2.StartPos = screwTrans.position;
_simpleMotion2.StartEurler = screwTrans.eulerAngles;
_simpleMotion2.RotateAxis = rotateAxis;
float rotateDegree = disNCL / MotionPara.rotateDegreeRate * 360f;
_simpleMotion2.RotateSpeed = MotionPara.wrenchSpeed * 7;
_simpleMotion2.StandardTime = rotateDegree / _simpleMotion2.RotateSpeed;
motionVec = -rotateAxis * disNCL;
emptyObj.transform.Translate(motionVec, Space.Self);
motionVec = _simpleMotion2.ParentTrans.TransformDirection(motionVec).normalized * disNCL;
_simpleMotion2.SpeedVector = motionVec / _simpleMotion2.StandardTime;
_simpleMotion2.EndPos = emptyObj.transform.position;
emptyObj.transform.Rotate(rotateAxis * rotateDegree, Space.Self);
_simpleMotion2.EndEurler = emptyObj.transform.eulerAngles;
emptyRefer.transform.parent = null;
emptyObj.transform.position = _simpleMotion2.StartPos;
emptyObj.transform.eulerAngles = _simpleMotion2.StartEurler;
_simpleMotion2.EmptyObj = emptyObj;
_simpleMotion2.EndTime = _simpleMotion2.StandardTime / _simpleMotion2.SpeedRate;
tempMotionList.Add(_simpleMotion2);
//最后退出 New---Class
BasicMotion _simpleMotion6 = new BasicMotion();
_simpleMotion6.State = CurrentState.Future;
_simpleMotion6.CurrentMotion = MotionType.MoveOnly;
_simpleMotion6.StartPos = emptyRefer.transform.position;
_simpleMotion6.StartEurler = emptyRefer.transform.eulerAngles;
_simpleMotion6.ParentTrans = firstObj;
_simpleMotion6.ListCopy(childList, parentList);
motionVec = -moveVecUnit * disNC;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion6.EndPos = emptyRefer.transform.position;
_simpleMotion6.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion6.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion6.SpeedVector = motionVec / _simpleMotion6.StandardTime;
_simpleMotion6.EndTime = _simpleMotion6.StandardTime / _simpleMotion6.SpeedRate;
tempMotionList.Add(_simpleMotion6);
_complexMotionList.Add(tempMotionList);
emptyRefer.transform.parent = null;
GameObject.DestroyImmediate(emptyRefer);
return true;
}
//部件摆放处理
private bool ObjPut(DataRow program_row, string id, DataTable group_table, IList<IMotion> _motionList,
IList<IList<IMotion>> _complexMotionList){
Transform firstObj = null;
List<Transform> parentList = new List<Transform>();
List<Transform> childList = new List<Transform>();
bool isRight = true;
//Group Column
int groupColumn = IntConversion((string)program_row[3].ToString(), ref isRight) + 1;
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFGROUP", id) + "，任意摆放运动Group填写错误！");
}
return false;
}
//运动物体信息
string objName = "";
try{
objName = (string)group_table.Rows[0][groupColumn].ToString();
firstObj = GameObject.Find(objName).transform;
for (int i = 1; i < group_table.Rows.Count; i++)
{
objName = (string)group_table.Rows[i][groupColumn].ToString();
if(objName == "")
break;
Transform tempTrans = GameObject.Find(objName).transform;
childList.Add(tempTrans);
parentList.Add(tempTrans.parent);
}
}catch{
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFGROUP", id) + "，Group号对应的Group表填写有错误！");
}
return false;
}
//参考物体
Transform referTrans = null;
try{
referTrans = GameObject.Find((string)program_row[4].ToString()).transform;
}catch{
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFREFER", id) + "，任意摆放运动参考物体填写错误！");
}
return false;
}
//判断是工具移出还是任意部件移动，默认为任意部件
bool isTool = false;
if(program_row.Table.Columns.Count >= 5){
if((string)program_row[5].ToString() == ""){
isTool = true;
}
}
//任意部件移动信息提取
Vector3 finalPos = new Vector3(0f, 0f, 0f);
Vector3 finalEuler = new Vector3(0f, 0f, 0f);
if(!isTool){
if(program_row.Table.Columns.Count >= 7){
//提取相对位置
finalPos = Vector3Conversion((string)program_row[5].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFPOS", id) + "，相对位置信息填写有错误！");
}
return false;
}
//提取相对角度
finalEuler = Vector3Conversion((string)program_row[6].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFEULER", id) + "，相对角度信息填写有错误！");
}
return false;
}
GameObject emptyRefer = new GameObject();
emptyRefer.name = "ObjPut_empty_Refer-" + id;
emptyRefer.transform.parent = referTrans;
emptyRefer.transform.localPosition = finalPos;
emptyRefer.transform.localEulerAngles = finalEuler;
finalPos = emptyRefer.transform.position;
finalEuler = emptyRefer.transform.eulerAngles;
emptyRefer.transform.parent = null;
GameObject.DestroyImmediate(emptyRefer);
}else{
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFEULER", id) + "，相对位置或角度信息填写有错误！");
}
return false;
}
}else{
int toolIndex = MotionPara.toolsName.IndexOf(objName);
if(toolIndex == -1){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFGROUP", id) +
"，Group号对应的Group表第一个物体在Tool.xls工具信息中找不到，请确认！");
}
return false;
}else{
finalPos = MotionPara.toolsInitPos[toolIndex];
finalEuler = MotionPara.toolsInitEuler[toolIndex];
}
}
//自定义速度提取
float moveSpeed = MotionPara.toolMoveSpeed;
if(program_row.Table.Columns.Count > 7){
if((string)program_row[7].ToString() != ""){
moveSpeed = FloatConversion((string)program_row[7].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFSPEED", id) + "，自定义速度填写有错误！");
}
return false;
}
}
}
//自定义安全高度
float safeHeight = MotionPara.safeHeight;
if(program_row.Table.Columns.Count > 8){
if((string)program_row[8].ToString() != ""){
safeHeight = FloatConversion((string)program_row[8].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFHEIGHT", id) + "，自定义安全高度填写有错误！");
}
return false;
}
}
}
//开始生成类数据
IList<IMotion> tempMotionList = new List<IMotion>();
//首先上升到安全高度
//New Class，世界坐标移动
BasicMotion _simpleMotion = new BasicMotion();
_simpleMotion.State = CurrentState.Active;
_simpleMotion.CurrentMotion = MotionType.WorldMove;
_simpleMotion.StartPos = firstObj.position;
_simpleMotion.StartEurler = firstObj.eulerAngles;
_simpleMotion.ParentTrans = firstObj;
_simpleMotion.ListCopy(childList, parentList);
//如果部件摆放的safeHeight对应的轴要改，修改这个参数
Vector3 motionVec = new Vector3(0f, safeHeight - _simpleMotion.StartPos.y, 0f);
_simpleMotion.EndPos = new Vector3(_simpleMotion.StartPos.x, safeHeight, _simpleMotion.StartPos.z);
_simpleMotion.EndEurler = _simpleMotion.StartEurler;
if(motionVec.magnitude == 0f){
_simpleMotion.StandardTime = 0.05f;
_simpleMotion.SpeedVector = new Vector3(0f, 0f, 0f);
}else{
_simpleMotion.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion.SpeedVector = motionVec / _simpleMotion.StandardTime;
}
_simpleMotion.EndTime = _simpleMotion.StandardTime / _simpleMotion.SpeedRate;
tempMotionList.Add(_simpleMotion);
//New Class---任意移动过度到目标位置上方
BasicMotion _simpleMotion2 = new BasicMotion();
_simpleMotion2.State = CurrentState.Future;
_simpleMotion2.CurrentMotion = MotionType.RandomMotion;
_simpleMotion2.StartPos = _simpleMotion.EndPos;
_simpleMotion2.StartEurler = _simpleMotion.EndEurler;
_simpleMotion2.ParentTrans = firstObj;
_simpleMotion2.ListCopy(childList, parentList);
_simpleMotion2.EndPos = new Vector3(finalPos.x, safeHeight, finalPos.z);
_simpleMotion2.EndEurler = finalEuler;
motionVec = _simpleMotion2.EndPos - _simpleMotion2.StartPos;
float moveTime = 0;
float rotateTime = 0;
moveTime = motionVec.magnitude / moveSpeed;
Vector3 angleDiff = GetAngleDiff(_simpleMotion2.StartEurler, ref _simpleMotion2.EndEurler);
rotateTime = Vector3.Angle(_simpleMotion2.StartEurler, _simpleMotion2.EndEurler) / MotionPara.toolRotateSpeed;
if(moveTime == 0 && rotateTime == 0){
_simpleMotion2.StandardTime = 0.05f;
_simpleMotion2.SpeedVector = Vector3.zero;
_simpleMotion2.AngleVector = Vector3.zero;
}else if(moveTime > rotateTime){
_simpleMotion2.StandardTime = moveTime;
_simpleMotion2.SpeedVector = motionVec / moveTime;
_simpleMotion2.AngleVector = angleDiff / moveTime;
}else{
_simpleMotion2.StandardTime = rotateTime;
_simpleMotion2.SpeedVector = motionVec / rotateTime;
_simpleMotion2.AngleVector = angleDiff / rotateTime;
}
_simpleMotion2.EndTime = _simpleMotion2.StandardTime / _simpleMotion2.SpeedRate;
tempMotionList.Add(_simpleMotion2);
//New Class，下移到目标位置
BasicMotion _simpleMotion3 = new BasicMotion();
_simpleMotion3.State = CurrentState.Future;
_simpleMotion3.CurrentMotion = MotionType.WorldMove;
_simpleMotion3.StartPos = _simpleMotion2.EndPos;
_simpleMotion3.StartEurler = _simpleMotion2.EndEurler;
_simpleMotion3.ParentTrans = firstObj;
_simpleMotion3.ListCopy(childList, parentList);
_simpleMotion3.EndPos = finalPos;
_simpleMotion3.EndEurler = finalEuler;
motionVec = _simpleMotion3.EndPos - _simpleMotion3.StartPos;
if(motionVec.magnitude == 0f){
_simpleMotion3.StandardTime = 0.05f;
_simpleMotion3.SpeedVector = new Vector3(0f, 0f, 0f);
}else{
_simpleMotion3.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion3.SpeedVector = motionVec / _simpleMotion3.StandardTime;
}
_simpleMotion3.EndTime = _simpleMotion3.StandardTime / _simpleMotion3.SpeedRate;
tempMotionList.Add(_simpleMotion3);
_complexMotionList.Add(tempMotionList);
return true;
}
//螺钉拧松拧紧
private bool NingSong(DataRow program_row, string id, DataTable group_table, IList<IMotion> _motionList,
IList<IList<IMotion>> _complexMotionList){
Transform firstObj = null;
Transform firstObjParent = null;
List<Transform> parentList = new List<Transform>();
List<Transform> childList = new List<Transform>();
Transform screwTrans = null;
Transform screwTransParent = null;
bool isRight = true;
//Group Column
int groupColumn = IntConversion((string)program_row[3].ToString(), ref isRight) + 1;
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSGROUP", id) + "，螺钉拧松运动Group填写错误！");
}
return false;
}
//运动物体信息
string objName = "";
try{
objName = (string)group_table.Rows[0][groupColumn].ToString();
firstObj = GameObject.Find(objName).transform;
firstObjParent = firstObj.parent;
for (int i = 1; i < group_table.Rows.Count; i++)
{
objName = (string)group_table.Rows[i][groupColumn].ToString();
if(objName == "")
break;
Transform tempTrans = GameObject.Find(objName).transform;
childList.Add(tempTrans);
parentList.Add(tempTrans.parent);
}
}catch{
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSGROUP", id) + "，Group号对应的Group表填写有错误！");
}
return false;
}
//被拧物体
try{
screwTrans = GameObject.Find((string)program_row[4].ToString()).transform;
screwTransParent = screwTrans.parent;
}catch{
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSREFER", id) + "，被拧物体填写有错误！");
}
return false;
}
//拧的次数
int twistTimes = IntConversion((string)program_row[5].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSTIMES", id) + "，拧的次数填写有错误！");
}
return false;
}
//扳手到螺钉距离
Vector3 disNSVec = Vector3Conversion((string)program_row[6].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSDIS", id) + "，拧的距离填写有错误！");
}
return false;
}
float disNS = disNSVec.magnitude;
//旋转轴
Vector3 rotateAxis = Vector3Conversion((string)program_row[7].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSAXIS", id) + "，拧的旋转轴填写有错误！");
}
return false;
}
//拧的角度大小
float twistDegree = FloatConversion((string)program_row[8].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSDEGREE", id) + "，拧的旋转轴填写有错误！");
}
return false;
}
//移动速度
float moveSpeed = MotionPara.toolMoveSpeed;
if(program_row.Table.Columns.Count > 9){
if((string)program_row[9].ToString() != ""){
moveSpeed = FloatConversion((string)program_row[9].ToString(), ref isRight);
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSSPEED", id) + "，自定义速度填写有错误！");
}
return false;
}
}
}
//扳手移出的微小距离
float wrenchBackDis = MotionPara.wrenchBackDis;
if (program_row.Table.Columns.Count > 10)
{
if ((string)program_row[10].ToString() != "")
{
wrenchBackDis = FloatConversion((string)program_row[10].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSWREHCHDIS", id) + "，自定义扳手回退距离填写有错误！");
}
return false;
}
}
}
//扳手移进时的坐标轴，如果要通用化，请修改这里
Vector3 moveVecUnit = new Vector3(-1.0f, 0f, 0f);
if (program_row.Table.Columns.Count > 11)
{
if ((string)program_row[11].ToString() != "")
{
moveVecUnit = Vector3Conversion((string)program_row[11].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSBANSHOU", id) + "，自定义扳手坐标轴填写有错误！");
}
return false;
}
}
}
//参考空物体
GameObject emptyRefer = new GameObject();
emptyRefer.name = "NingSong_empty-" + id;
//开始生成类数据
IList<IMotion> tempMotionList = new List<IMotion>();
//首次移进 New---Class
BasicMotion _simpleMotion = new BasicMotion();
_simpleMotion.State = CurrentState.Active;
_simpleMotion.CurrentMotion = MotionType.MoveOnly;
_simpleMotion.StartPos = firstObj.position;
_simpleMotion.StartEurler = firstObj.eulerAngles;
emptyRefer.transform.position = firstObj.position;
emptyRefer.transform.eulerAngles = firstObj.eulerAngles;
_simpleMotion.ParentTrans = firstObj;
_simpleMotion.ListCopy(childList, parentList);
//扳手拧一圈时移动的距离
float screwBack = (twistDegree / 30f) * MotionPara.screwBackRate;
Vector3 motionVec = moveVecUnit * disNS;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion.EndPos = emptyRefer.transform.position;
_simpleMotion.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion.SpeedVector = motionVec / _simpleMotion.StandardTime;
_simpleMotion.EndTime = _simpleMotion.StandardTime / _simpleMotion.SpeedRate;
tempMotionList.Add(_simpleMotion);
for(int i = 0; i < twistTimes; i++){
//拧 New---Class
BasicMotion _simpleMotion2 = new BasicMotion();
_simpleMotion2.State = CurrentState.Future;
_simpleMotion2.CurrentMotion = MotionType.MoveRotateSingle;
_simpleMotion2.ParentTrans = screwTrans;
_simpleMotion2.ListCopy(childList, parentList);
_simpleMotion2.ChildList.Add(firstObj);
_simpleMotion2.ParentList.Add(firstObjParent);
_simpleMotion2.ChildList.Add(screwTrans);
_simpleMotion2.ParentList.Add(screwTransParent);
GameObject emptyObj = new GameObject();
emptyObj.name = "move-rotate_empty-" + id + "-" + i.ToString();
emptyObj.transform.position = screwTrans.position;
emptyObj.transform.eulerAngles = screwTrans.eulerAngles;
//将emptyRefer当做扳手用于后面过程定位
emptyRefer.transform.parent = emptyObj.transform;
_simpleMotion2.StartPos = screwTrans.position;
_simpleMotion2.StartEurler = screwTrans.eulerAngles;
_simpleMotion2.RotateAxis = rotateAxis;
_simpleMotion2.RotateSpeed = MotionPara.wrenchSpeed;
_simpleMotion2.StandardTime = twistDegree / _simpleMotion2.RotateSpeed;
motionVec = -rotateAxis * screwBack;
emptyObj.transform.Translate(motionVec, Space.Self);
motionVec = _simpleMotion2.ParentTrans.TransformDirection(motionVec).normalized * screwBack;
_simpleMotion2.SpeedVector = motionVec / _simpleMotion2.StandardTime;
_simpleMotion2.EndPos = emptyObj.transform.position;
emptyObj.transform.Rotate(rotateAxis * twistDegree, Space.Self);
_simpleMotion2.EndEurler = emptyObj.transform.eulerAngles;
emptyRefer.transform.parent = null;
emptyObj.transform.position = _simpleMotion2.StartPos;
emptyObj.transform.eulerAngles = _simpleMotion2.StartEurler;
_simpleMotion2.EmptyObj = emptyObj;
_simpleMotion2.EndTime = _simpleMotion2.StandardTime / _simpleMotion2.SpeedRate;
tempMotionList.Add(_simpleMotion2);
//中间循环动作
if(twistTimes - i > 1){
//扳手退出很小的距离 New---Class
BasicMotion _simpleMotion3 = new BasicMotion();
_simpleMotion3.State = CurrentState.Future;
_simpleMotion3.CurrentMotion = MotionType.MoveOnly;
_simpleMotion3.ParentTrans = firstObj;
_simpleMotion3.ListCopy(childList, parentList);
_simpleMotion3.StartPos = emptyRefer.transform.position;
_simpleMotion3.StartEurler = emptyRefer.transform.eulerAngles;
motionVec = new Vector3(1f, 0f, 0f) * wrenchBackDis / 3;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion3.EndPos = emptyRefer.transform.position;
_simpleMotion3.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion3.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion3.SpeedVector = motionVec / _simpleMotion3.StandardTime;
_simpleMotion3.EndTime = _simpleMotion3.StandardTime / _simpleMotion3.SpeedRate;
tempMotionList.Add(_simpleMotion3);
//扳手回转 New---Class
BasicMotion _simpleMotion4 = new BasicMotion();
_simpleMotion4.State = CurrentState.Future;
_simpleMotion4.CurrentMotion = MotionType.RotateOnly;
_simpleMotion4.ParentTrans = firstObj;
_simpleMotion4.ListCopy(childList, parentList);
_simpleMotion4.StartPos = emptyRefer.transform.position;
_simpleMotion4.StartEurler = emptyRefer.transform.eulerAngles;
_simpleMotion4.RotateCenter = _simpleMotion4.ParentTrans.position;
_simpleMotion4.RotateAxis = new Vector3(rotateAxis.z, 0f, 0f);
_simpleMotion4.RotateAxis = _simpleMotion4.ParentTrans.TransformDirection(_simpleMotion4.RotateAxis);
_simpleMotion4.RotateSpeed = MotionPara.wrenchSpeed * 4f;
_simpleMotion4.StandardTime = twistDegree / _simpleMotion4.RotateSpeed;
emptyRefer.transform.RotateAround(_simpleMotion4.RotateCenter, _simpleMotion4.RotateAxis, twistDegree);
_simpleMotion4.EndPos = emptyRefer.transform.position;
_simpleMotion4.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion4.EndTime = _simpleMotion4.StandardTime / _simpleMotion4.SpeedRate;
tempMotionList.Add(_simpleMotion4);
//扳手再次进入 New---Class
BasicMotion _simpleMotion5 = new BasicMotion();
_simpleMotion5.State = CurrentState.Future;
_simpleMotion5.CurrentMotion = MotionType.MoveOnly;
_simpleMotion5.ParentTrans = firstObj;
_simpleMotion5.ListCopy(childList, parentList);
_simpleMotion5.StartPos = emptyRefer.transform.position;
_simpleMotion5.StartEurler = emptyRefer.transform.eulerAngles;
motionVec = new Vector3(-1f, 0f, 0f) * wrenchBackDis / 3;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion5.EndPos = emptyRefer.transform.position;
_simpleMotion5.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion5.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion5.SpeedVector = motionVec / _simpleMotion5.StandardTime;
_simpleMotion5.EndTime = _simpleMotion5.StandardTime / _simpleMotion5.SpeedRate;
tempMotionList.Add(_simpleMotion5);
}
}
//最后退出 New---Class
BasicMotion _simpleMotion6 = new BasicMotion();
_simpleMotion6.State = CurrentState.Future;
_simpleMotion6.CurrentMotion = MotionType.MoveOnly;
_simpleMotion6.StartPos = emptyRefer.transform.position;
_simpleMotion6.StartEurler = emptyRefer.transform.eulerAngles;
_simpleMotion6.ParentTrans = firstObj;
_simpleMotion6.ListCopy(childList, parentList);
motionVec = -moveVecUnit * disNS;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion6.EndPos = emptyRefer.transform.position;
_simpleMotion6.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion6.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion6.SpeedVector = motionVec / _simpleMotion6.StandardTime;
_simpleMotion6.EndTime = _simpleMotion6.StandardTime / _simpleMotion6.SpeedRate;
tempMotionList.Add(_simpleMotion6);
_complexMotionList.Add(tempMotionList);
emptyRefer.transform.parent = null;
GameObject.DestroyImmediate(emptyRefer);
return true;
}
//铜棒敲击处理
private bool CopperHit(DataRow program_row, string id, DataTable group_table, IList<IMotion> _motionList,
IList<IList<IMotion>> _complexMotionList){
//铜棒运动时的父亲
GameObject empty = new GameObject();
empty.name = "copper_empty-" + id;
Transform copperTrans = null;
Transform firstObj = null;
// Transform firstObjParent = null;
List<Transform> parentList = new List<Transform>();
List<Transform> childList = new List<Transform>();
try{
//铜棒
copperTrans = GameObject.Find(MotionPara.copperName).transform;
}catch{
if(MotionPara.isEditor){
Debug.LogError(MotionPara.copperName + "：在此场景中未能找到铜棒！");
}
return false;
}
bool isRight = true;
//Group Column
int groupColumn = IntConversion(program_row[3].ToString(), ref isRight) + 1;
if(!isRight){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "TBGROUP", id) + "，铜棒运动Group填写错误！");
}
return false;
}
//运动物体信息
string objName = "";
try{
objName = (string)group_table.Rows[0][groupColumn].ToString();
firstObj = GameObject.Find(objName).transform;
// firstObjParent = firstObj.parent;
empty.transform.position = firstObj.position;
empty.transform.eulerAngles = firstObj.eulerAngles;
// firstObj.parent = empty.transform;
for (int i = 1; i < group_table.Rows.Count; i++)
{
objName = (string)group_table.Rows[i][groupColumn].ToString();
if(objName == "")
break;
Transform tempTrans = GameObject.Find(objName).transform;
childList.Add(tempTrans);
parentList.Add(tempTrans.parent);
// tempTrans.parent = empty.transform;
}
}catch{
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("PROGRAM", "TBGROUP", id) + "，Group号对应的Group表填写有错误！");
}
return false;
}
//敲击次数
int copperTimes = IntConversion((string)program_row[4].ToString(), ref isRight);
if(!isRight || copperTimes == 0){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBTIMES", id) + "，铜棒敲击次数填写有错误！");
}
return false;
}
//铜棒离敲击点距离
Vector3 disTBVec = Vector3Conversion((string)program_row[5].ToString(), ref isRight);
if(!isRight || disTBVec.magnitude == 0){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBDIS", id) + "，铜棒敲击距离填写有错误！");
}
return false;
}
float disTB = disTBVec.magnitude; //铜棒移动距离
//物体移动方向
Vector3 dirTBVec = Vector3Conversion((string)program_row[6].ToString(), ref isRight);
if(!isRight || dirTBVec.magnitude == 0){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBDIR", id) + "，铜棒敲击物体移动方向填写有错误！");
}
return false;
}
//移动速度确定
float copperHitSpeed = MotionPara.copperHitSpeed;
//检测是否有自定义速度
if(program_row.Table.Columns.Count > 7){
if((string)program_row[7].ToString() != ""){
copperHitSpeed = FloatConversion((string)program_row[7].ToString(), ref isRight);
if(!isRight || copperHitSpeed == 0){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBSPEED", id) + "，铜棒自定义速度填写有错误！");
}
return false;
}
}
}
float copperBackSpeed = copperHitSpeed / 3f;
//铜棒敲击一次移动距离
float copperForwardDis = MotionPara.copperForwardDis;
//检测是否有自定义距离
if(program_row.Table.Columns.Count > 8){
if((string)program_row[8].ToString() != ""){
copperForwardDis = FloatConversion((string)program_row[8].ToString(), ref isRight);
if(!isRight || copperForwardDis == 0){
if(MotionPara.isEditor){
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBFORWARDDIS", id) + "，铜棒自定义敲击移动距离填写有错误！");
}
return false;
}
}
}
GameObject emptyPos = new GameObject();
emptyPos.name = "copper_empty_position--" + id;
//敲击类创建
IList<IMotion> tempMotionList = new List<IMotion>();
for(int i = 0; i < copperTimes; i++)
{
//铜棒敲击---New Class
BasicMotion _simpleMotion = new BasicMotion();
Vector3 motionVec = MotionPara.copperVector * (disTB + i * copperForwardDis);
_simpleMotion.CurrentMotion = MotionType.MoveOnly;
_simpleMotion.ParentTrans = copperTrans;
_simpleMotion.MoveSpeed = copperHitSpeed;
_simpleMotion.StandardTime = motionVec.magnitude / copperHitSpeed;
_simpleMotion.SpeedVector = motionVec / _simpleMotion.StandardTime;
//起始信息记录
_simpleMotion.StartPos = copperTrans.position;
_simpleMotion.StartEurler = copperTrans.eulerAngles;
emptyPos.transform.position = _simpleMotion.StartPos;
emptyPos.transform.eulerAngles = _simpleMotion.StartEurler;
emptyPos.transform.Translate(motionVec, Space.Self);
//终止信息记录
_simpleMotion.EndPos = emptyPos.transform.position;
_simpleMotion.EndEurler = emptyPos.transform.eulerAngles;
_simpleMotion.EndTime = _simpleMotion.StandardTime / _simpleMotion.SpeedRate;
if(i == 0){
_simpleMotion.State = CurrentState.Active;
}else{
_simpleMotion.State = CurrentState.Future;
}
tempMotionList.Add(_simpleMotion);
//被敲击物体瞬移---New Class
BasicMotion _simpleMotion2 = new BasicMotion();
_simpleMotion2.State = CurrentState.Future;
_simpleMotion2.CurrentMotion = MotionType.SetPos;
_simpleMotion2.ParentTrans = firstObj;
_simpleMotion2.ListCopy(childList, parentList);
//起始信息记录
emptyPos.transform.position = empty.transform.position;
emptyPos.transform.eulerAngles = empty.transform.eulerAngles;
_simpleMotion2.StartPos = emptyPos.transform.position;
_simpleMotion2.StartEurler = emptyPos.transform.eulerAngles;
emptyPos.transform.Translate(dirTBVec.normalized * (i + 1) * copperForwardDis, Space.Self);
//终止信息记录
_simpleMotion2.EndPos = emptyPos.transform.position;
_simpleMotion2.EndEurler = emptyPos.transform.eulerAngles;
//时间记录
_simpleMotion2.StandardTime = 0.05f;
_simpleMotion2.EndTime = 0.05f;
tempMotionList.Add(_simpleMotion2);
//铜棒返回---New Class
BasicMotion _simpleMotion3 = new BasicMotion();
_simpleMotion3.State = CurrentState.Future;
_simpleMotion3.CurrentMotion = MotionType.MoveOnly;
_simpleMotion3.ParentTrans = copperTrans;
_simpleMotion3.MoveSpeed = copperBackSpeed;
_simpleMotion3.StandardTime = motionVec.magnitude / copperBackSpeed;
_simpleMotion3.SpeedVector = -motionVec / _simpleMotion3.StandardTime;
//起始信息记录
_simpleMotion3.StartPos = _simpleMotion.EndPos;
_simpleMotion3.StartEurler = _simpleMotion.EndEurler;
//终止信息记录
_simpleMotion3.EndPos = _simpleMotion.StartPos;
_simpleMotion3.EndEurler = _simpleMotion.StartEurler;
_simpleMotion3.EndTime = _simpleMotion3.StandardTime / _simpleMotion3.SpeedRate;
tempMotionList.Add(_simpleMotion3);
}
_complexMotionList.Add(tempMotionList);
GameObject.DestroyImmediate(emptyPos);
GameObject.DestroyImmediate(empty);
return true;
}
//螺钉拧进拧出
private bool NingChu(DataRow program_row, string id, DataTable group_table, IList <IMotion> _motionList,
IList <IList <IMotion> > _complexMotionList)
{
Transform firstObj = null;
Transform firstObjParent = null;
List <Transform> parentList = new List <Transform>();
List <Transform> childList = new List <Transform>();
Transform screwTrans = null;
Transform screwTransParent = null;
bool isRight = true;
//Group Column
int groupColumn = IntConversion((string)program_row[3].ToString(), ref isRight) + 1;
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCGROUP", id) + "，螺钉拧出运动Group填写错误！");
}
return(false);
}
//运动物体信息
string objName = "";
try{
objName = (string)group_table.Rows[0][groupColumn].ToString();
firstObj = GameObject.Find(objName).transform;
firstObjParent = firstObj.parent;
for (int i = 1; i < group_table.Rows.Count; i++)
{
objName = (string)group_table.Rows[i][groupColumn].ToString();
if (objName == "")
{
break;
}
Transform tempTrans = GameObject.Find(objName).transform;
childList.Add(tempTrans);
parentList.Add(tempTrans.parent);
}
}catch {
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCGROUP", id) + "，Group号对应的Group表填写有错误！");
}
return(false);
}
//被拧物体
try{
screwTrans = GameObject.Find((string)program_row[4].ToString()).transform;
screwTransParent = screwTrans.parent;
}catch {
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCREFER", id) + "，被拧物体填写有错误！");
}
return(false);
}
//扳手到螺钉距离
Vector3 disNCVec = Vector3Conversion((string)program_row[5].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCDIS", id) + "，拧的距离填写有错误！");
}
return(false);
}
float disNC = disNCVec.magnitude;
//旋转轴
Vector3 rotateAxis = Vector3Conversion((string)program_row[6].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCAXIS", id) + "，拧的旋转轴填写有错误！");
}
return(false);
}
//螺钉拧出的距离
Vector3 disNCLVec = Vector3Conversion((string)program_row[7].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCLDIS", id) + "，拧出来的距离填写有错误！");
}
return(false);
}
float disNCL = disNCLVec.magnitude;
//移动速度
float moveSpeed = MotionPara.toolMoveSpeed;
if (program_row.Table.Columns.Count > 8)
{
if ((string)program_row[8].ToString() != "")
{
moveSpeed = FloatConversion((string)program_row[8].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCSPEED", id) + "，自定义速度填写有错误！");
}
return(false);
}
}
}
//扳手移进时的坐标轴，如果要通用化，请修改这里
Vector3 moveVecUnit = new Vector3(0f, -1.0f, 0f);
if (program_row.Table.Columns.Count > 9)
{
if ((string)program_row[9].ToString() != "")
{
moveVecUnit = Vector3Conversion((string)program_row[9].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NCBANSHOU", id) + "，自定义扳手坐标轴填写有错误！");
}
return(false);
}
}
}
//参考空物体
GameObject emptyRefer = new GameObject();
emptyRefer.name = "NingChu_empty-" + id;
//开始生成类数据
IList <IMotion> tempMotionList = new List <IMotion>();
//首次移进 New---Class
BasicMotion _simpleMotion = new BasicMotion();
_simpleMotion.State = CurrentState.Active;
_simpleMotion.CurrentMotion = MotionType.MoveOnly;
_simpleMotion.StartPos = firstObj.position;
_simpleMotion.StartEurler = firstObj.eulerAngles;
emptyRefer.transform.position = firstObj.position;
emptyRefer.transform.eulerAngles = firstObj.eulerAngles;
_simpleMotion.ParentTrans = firstObj;
_simpleMotion.ListCopy(childList, parentList);
Vector3 motionVec = moveVecUnit * disNC;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion.EndPos = emptyRefer.transform.position;
_simpleMotion.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion.SpeedVector = motionVec / _simpleMotion.StandardTime;
_simpleMotion.EndTime = _simpleMotion.StandardTime / _simpleMotion.SpeedRate;
tempMotionList.Add(_simpleMotion);
//拧出 New---Class
BasicMotion _simpleMotion2 = new BasicMotion();
_simpleMotion2.State = CurrentState.Future;
_simpleMotion2.CurrentMotion = MotionType.MoveRotateSingle;
_simpleMotion2.ParentTrans = screwTrans;
_simpleMotion2.ListCopy(childList, parentList);
_simpleMotion2.ChildList.Add(firstObj);
_simpleMotion2.ParentList.Add(firstObjParent);
_simpleMotion2.ChildList.Add(screwTrans);
_simpleMotion2.ParentList.Add(screwTransParent);
GameObject emptyObj = new GameObject();
emptyObj.name = "move-rotate_empty-" + id + "-ningchu";
emptyObj.transform.position = screwTrans.position;
emptyObj.transform.eulerAngles = screwTrans.eulerAngles;
//将emptyRefer当做扳手用于后面过程定位
emptyRefer.transform.parent = emptyObj.transform;
_simpleMotion2.StartPos = screwTrans.position;
_simpleMotion2.StartEurler = screwTrans.eulerAngles;
_simpleMotion2.RotateAxis = rotateAxis;
float rotateDegree = disNCL / MotionPara.rotateDegreeRate * 360f;
_simpleMotion2.RotateSpeed = MotionPara.wrenchSpeed * 7;
_simpleMotion2.StandardTime = rotateDegree / _simpleMotion2.RotateSpeed;
motionVec = -rotateAxis * disNCL;
emptyObj.transform.Translate(motionVec, Space.Self);
motionVec = _simpleMotion2.ParentTrans.TransformDirection(motionVec).normalized *disNCL;
_simpleMotion2.SpeedVector = motionVec / _simpleMotion2.StandardTime;
_simpleMotion2.EndPos = emptyObj.transform.position;
emptyObj.transform.Rotate(rotateAxis * rotateDegree, Space.Self);
_simpleMotion2.EndEurler = emptyObj.transform.eulerAngles;
emptyRefer.transform.parent = null;
emptyObj.transform.position = _simpleMotion2.StartPos;
emptyObj.transform.eulerAngles = _simpleMotion2.StartEurler;
_simpleMotion2.EmptyObj = emptyObj;
_simpleMotion2.EndTime = _simpleMotion2.StandardTime / _simpleMotion2.SpeedRate;
tempMotionList.Add(_simpleMotion2);
//最后退出 New---Class
BasicMotion _simpleMotion6 = new BasicMotion();
_simpleMotion6.State = CurrentState.Future;
_simpleMotion6.CurrentMotion = MotionType.MoveOnly;
_simpleMotion6.StartPos = emptyRefer.transform.position;
_simpleMotion6.StartEurler = emptyRefer.transform.eulerAngles;
_simpleMotion6.ParentTrans = firstObj;
_simpleMotion6.ListCopy(childList, parentList);
motionVec = -moveVecUnit * disNC;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion6.EndPos = emptyRefer.transform.position;
_simpleMotion6.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion6.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion6.SpeedVector = motionVec / _simpleMotion6.StandardTime;
_simpleMotion6.EndTime = _simpleMotion6.StandardTime / _simpleMotion6.SpeedRate;
tempMotionList.Add(_simpleMotion6);
_complexMotionList.Add(tempMotionList);
emptyRefer.transform.parent = null;
GameObject.DestroyImmediate(emptyRefer);
return(true);
}
//螺钉拧松拧紧
private bool NingSong(DataRow program_row, string id, DataTable group_table, IList <IMotion> _motionList,
IList <IList <IMotion> > _complexMotionList)
{
Transform firstObj = null;
Transform firstObjParent = null;
List <Transform> parentList = new List <Transform>();
List <Transform> childList = new List <Transform>();
Transform screwTrans = null;
Transform screwTransParent = null;
bool isRight = true;
//Group Column
int groupColumn = IntConversion((string)program_row[3].ToString(), ref isRight) + 1;
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSGROUP", id) + "，螺钉拧松运动Group填写错误！");
}
return(false);
}
//运动物体信息
string objName = "";
try{
objName = (string)group_table.Rows[0][groupColumn].ToString();
firstObj = GameObject.Find(objName).transform;
firstObjParent = firstObj.parent;
for (int i = 1; i < group_table.Rows.Count; i++)
{
objName = (string)group_table.Rows[i][groupColumn].ToString();
if (objName == "")
{
break;
}
Transform tempTrans = GameObject.Find(objName).transform;
childList.Add(tempTrans);
parentList.Add(tempTrans.parent);
}
}catch {
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSGROUP", id) + "，Group号对应的Group表填写有错误！");
}
return(false);
}
//被拧物体
try{
screwTrans = GameObject.Find((string)program_row[4].ToString()).transform;
screwTransParent = screwTrans.parent;
}catch {
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSREFER", id) + "，被拧物体填写有错误！");
}
return(false);
}
//拧的次数
int twistTimes = IntConversion((string)program_row[5].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSTIMES", id) + "，拧的次数填写有错误！");
}
return(false);
}
//扳手到螺钉距离
Vector3 disNSVec = Vector3Conversion((string)program_row[6].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSDIS", id) + "，拧的距离填写有错误！");
}
return(false);
}
float disNS = disNSVec.magnitude;
//旋转轴
Vector3 rotateAxis = Vector3Conversion((string)program_row[7].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSAXIS", id) + "，拧的旋转轴填写有错误！");
}
return(false);
}
//拧的角度大小
float twistDegree = FloatConversion((string)program_row[8].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSDEGREE", id) + "，拧的旋转轴填写有错误！");
}
return(false);
}
//移动速度
float moveSpeed = MotionPara.toolMoveSpeed;
if (program_row.Table.Columns.Count > 9)
{
if ((string)program_row[9].ToString() != "")
{
moveSpeed = FloatConversion((string)program_row[9].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSSPEED", id) + "，自定义速度填写有错误！");
}
return(false);
}
}
}
//扳手移出的微小距离
float wrenchBackDis = MotionPara.wrenchBackDis;
if (program_row.Table.Columns.Count > 10)
{
if ((string)program_row[10].ToString() != "")
{
wrenchBackDis = FloatConversion((string)program_row[10].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSWREHCHDIS", id) + "，自定义扳手回退距离填写有错误！");
}
return(false);
}
}
}
//扳手移进时的坐标轴，如果要通用化，请修改这里
Vector3 moveVecUnit = new Vector3(-1.0f, 0f, 0f);
if (program_row.Table.Columns.Count > 11)
{
if ((string)program_row[11].ToString() != "")
{
moveVecUnit = Vector3Conversion((string)program_row[11].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "NSBANSHOU", id) + "，自定义扳手坐标轴填写有错误！");
}
return(false);
}
}
}
//参考空物体
GameObject emptyRefer = new GameObject();
emptyRefer.name = "NingSong_empty-" + id;
//开始生成类数据
IList <IMotion> tempMotionList = new List <IMotion>();
//首次移进 New---Class
BasicMotion _simpleMotion = new BasicMotion();
_simpleMotion.State = CurrentState.Active;
_simpleMotion.CurrentMotion = MotionType.MoveOnly;
_simpleMotion.StartPos = firstObj.position;
_simpleMotion.StartEurler = firstObj.eulerAngles;
emptyRefer.transform.position = firstObj.position;
emptyRefer.transform.eulerAngles = firstObj.eulerAngles;
_simpleMotion.ParentTrans = firstObj;
_simpleMotion.ListCopy(childList, parentList);
//扳手拧一圈时移动的距离
float screwBack = (twistDegree / 30f) * MotionPara.screwBackRate;
Vector3 motionVec = moveVecUnit * disNS;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion.EndPos = emptyRefer.transform.position;
_simpleMotion.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion.SpeedVector = motionVec / _simpleMotion.StandardTime;
_simpleMotion.EndTime = _simpleMotion.StandardTime / _simpleMotion.SpeedRate;
tempMotionList.Add(_simpleMotion);
for (int i = 0; i < twistTimes; i++)
{
//拧 New---Class
BasicMotion _simpleMotion2 = new BasicMotion();
_simpleMotion2.State = CurrentState.Future;
_simpleMotion2.CurrentMotion = MotionType.MoveRotateSingle;
_simpleMotion2.ParentTrans = screwTrans;
_simpleMotion2.ListCopy(childList, parentList);
_simpleMotion2.ChildList.Add(firstObj);
_simpleMotion2.ParentList.Add(firstObjParent);
_simpleMotion2.ChildList.Add(screwTrans);
_simpleMotion2.ParentList.Add(screwTransParent);
GameObject emptyObj = new GameObject();
emptyObj.name = "move-rotate_empty-" + id + "-" + i.ToString();
emptyObj.transform.position = screwTrans.position;
emptyObj.transform.eulerAngles = screwTrans.eulerAngles;
//将emptyRefer当做扳手用于后面过程定位
emptyRefer.transform.parent = emptyObj.transform;
_simpleMotion2.StartPos = screwTrans.position;
_simpleMotion2.StartEurler = screwTrans.eulerAngles;
_simpleMotion2.RotateAxis = rotateAxis;
_simpleMotion2.RotateSpeed = MotionPara.wrenchSpeed;
_simpleMotion2.StandardTime = twistDegree / _simpleMotion2.RotateSpeed;
motionVec = -rotateAxis * screwBack;
emptyObj.transform.Translate(motionVec, Space.Self);
motionVec = _simpleMotion2.ParentTrans.TransformDirection(motionVec).normalized *screwBack;
_simpleMotion2.SpeedVector = motionVec / _simpleMotion2.StandardTime;
_simpleMotion2.EndPos = emptyObj.transform.position;
emptyObj.transform.Rotate(rotateAxis * twistDegree, Space.Self);
_simpleMotion2.EndEurler = emptyObj.transform.eulerAngles;
emptyRefer.transform.parent = null;
emptyObj.transform.position = _simpleMotion2.StartPos;
emptyObj.transform.eulerAngles = _simpleMotion2.StartEurler;
_simpleMotion2.EmptyObj = emptyObj;
_simpleMotion2.EndTime = _simpleMotion2.StandardTime / _simpleMotion2.SpeedRate;
tempMotionList.Add(_simpleMotion2);
//中间循环动作
if (twistTimes - i > 1)
{
//扳手退出很小的距离 New---Class
BasicMotion _simpleMotion3 = new BasicMotion();
_simpleMotion3.State = CurrentState.Future;
_simpleMotion3.CurrentMotion = MotionType.MoveOnly;
_simpleMotion3.ParentTrans = firstObj;
_simpleMotion3.ListCopy(childList, parentList);
_simpleMotion3.StartPos = emptyRefer.transform.position;
_simpleMotion3.StartEurler = emptyRefer.transform.eulerAngles;
motionVec = new Vector3(1f, 0f, 0f) * wrenchBackDis / 3;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion3.EndPos = emptyRefer.transform.position;
_simpleMotion3.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion3.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion3.SpeedVector = motionVec / _simpleMotion3.StandardTime;
_simpleMotion3.EndTime = _simpleMotion3.StandardTime / _simpleMotion3.SpeedRate;
tempMotionList.Add(_simpleMotion3);
//扳手回转 New---Class
BasicMotion _simpleMotion4 = new BasicMotion();
_simpleMotion4.State = CurrentState.Future;
_simpleMotion4.CurrentMotion = MotionType.RotateOnly;
_simpleMotion4.ParentTrans = firstObj;
_simpleMotion4.ListCopy(childList, parentList);
_simpleMotion4.StartPos = emptyRefer.transform.position;
_simpleMotion4.StartEurler = emptyRefer.transform.eulerAngles;
_simpleMotion4.RotateCenter = _simpleMotion4.ParentTrans.position;
_simpleMotion4.RotateAxis = new Vector3(rotateAxis.z, 0f, 0f);
_simpleMotion4.RotateAxis = _simpleMotion4.ParentTrans.TransformDirection(_simpleMotion4.RotateAxis);
_simpleMotion4.RotateSpeed = MotionPara.wrenchSpeed * 4f;
_simpleMotion4.StandardTime = twistDegree / _simpleMotion4.RotateSpeed;
emptyRefer.transform.RotateAround(_simpleMotion4.RotateCenter, _simpleMotion4.RotateAxis, twistDegree);
_simpleMotion4.EndPos = emptyRefer.transform.position;
_simpleMotion4.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion4.EndTime = _simpleMotion4.StandardTime / _simpleMotion4.SpeedRate;
tempMotionList.Add(_simpleMotion4);
//扳手再次进入 New---Class
BasicMotion _simpleMotion5 = new BasicMotion();
_simpleMotion5.State = CurrentState.Future;
_simpleMotion5.CurrentMotion = MotionType.MoveOnly;
_simpleMotion5.ParentTrans = firstObj;
_simpleMotion5.ListCopy(childList, parentList);
_simpleMotion5.StartPos = emptyRefer.transform.position;
_simpleMotion5.StartEurler = emptyRefer.transform.eulerAngles;
motionVec = new Vector3(-1f, 0f, 0f) * wrenchBackDis / 3;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion5.EndPos = emptyRefer.transform.position;
_simpleMotion5.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion5.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion5.SpeedVector = motionVec / _simpleMotion5.StandardTime;
_simpleMotion5.EndTime = _simpleMotion5.StandardTime / _simpleMotion5.SpeedRate;
tempMotionList.Add(_simpleMotion5);
}
}
//最后退出 New---Class
BasicMotion _simpleMotion6 = new BasicMotion();
_simpleMotion6.State = CurrentState.Future;
_simpleMotion6.CurrentMotion = MotionType.MoveOnly;
_simpleMotion6.StartPos = emptyRefer.transform.position;
_simpleMotion6.StartEurler = emptyRefer.transform.eulerAngles;
_simpleMotion6.ParentTrans = firstObj;
_simpleMotion6.ListCopy(childList, parentList);
motionVec = -moveVecUnit * disNS;
emptyRefer.transform.Translate(motionVec, Space.Self);
_simpleMotion6.EndPos = emptyRefer.transform.position;
_simpleMotion6.EndEurler = emptyRefer.transform.eulerAngles;
_simpleMotion6.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion6.SpeedVector = motionVec / _simpleMotion6.StandardTime;
_simpleMotion6.EndTime = _simpleMotion6.StandardTime / _simpleMotion6.SpeedRate;
tempMotionList.Add(_simpleMotion6);
_complexMotionList.Add(tempMotionList);
emptyRefer.transform.parent = null;
GameObject.DestroyImmediate(emptyRefer);
return(true);
}
//部件摆放处理
private bool ObjPut(DataRow program_row, string id, DataTable group_table, IList <IMotion> _motionList,
IList <IList <IMotion> > _complexMotionList)
{
Transform firstObj = null;
List <Transform> parentList = new List <Transform>();
List <Transform> childList = new List <Transform>();
bool isRight = true;
//Group Column
int groupColumn = IntConversion((string)program_row[3].ToString(), ref isRight) + 1;
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFGROUP", id) + "，任意摆放运动Group填写错误！");
}
return(false);
}
//运动物体信息
string objName = "";
try{
objName = (string)group_table.Rows[0][groupColumn].ToString();
firstObj = GameObject.Find(objName).transform;
for (int i = 1; i < group_table.Rows.Count; i++)
{
objName = (string)group_table.Rows[i][groupColumn].ToString();
if (objName == "")
{
break;
}
Transform tempTrans = GameObject.Find(objName).transform;
childList.Add(tempTrans);
parentList.Add(tempTrans.parent);
}
}catch {
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFGROUP", id) + "，Group号对应的Group表填写有错误！");
}
return(false);
}
//参考物体
Transform referTrans = null;
try{
referTrans = GameObject.Find((string)program_row[4].ToString()).transform;
}catch {
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFREFER", id) + "，任意摆放运动参考物体填写错误！");
}
return(false);
}
//判断是工具移出还是任意部件移动，默认为任意部件
bool isTool = false;
if (program_row.Table.Columns.Count >= 5)
{
if ((string)program_row[5].ToString() == "")
{
isTool = true;
}
}
//任意部件移动信息提取
Vector3 finalPos = new Vector3(0f, 0f, 0f);
Vector3 finalEuler = new Vector3(0f, 0f, 0f);
if (!isTool)
{
if (program_row.Table.Columns.Count >= 7)
{
//提取相对位置
finalPos = Vector3Conversion((string)program_row[5].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFPOS", id) + "，相对位置信息填写有错误！");
}
return(false);
}
//提取相对角度
finalEuler = Vector3Conversion((string)program_row[6].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFEULER", id) + "，相对角度信息填写有错误！");
}
return(false);
}
GameObject emptyRefer = new GameObject();
emptyRefer.name = "ObjPut_empty_Refer-" + id;
emptyRefer.transform.parent = referTrans;
emptyRefer.transform.localPosition = finalPos;
emptyRefer.transform.localEulerAngles = finalEuler;
finalPos = emptyRefer.transform.position;
finalEuler = emptyRefer.transform.eulerAngles;
emptyRefer.transform.parent = null;
GameObject.DestroyImmediate(emptyRefer);
}
else
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFEULER", id) + "，相对位置或角度信息填写有错误！");
}
return(false);
}
}
else
{
int toolIndex = MotionPara.toolsName.IndexOf(objName);
if (toolIndex == -1)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFGROUP", id) +
"，Group号对应的Group表第一个物体在Tool.xls工具信息中找不到，请确认！");
}
return(false);
}
else
{
finalPos = MotionPara.toolsInitPos[toolIndex];
finalEuler = MotionPara.toolsInitEuler[toolIndex];
}
}
//自定义速度提取
float moveSpeed = MotionPara.toolMoveSpeed;
if (program_row.Table.Columns.Count > 7)
{
if ((string)program_row[7].ToString() != "")
{
moveSpeed = FloatConversion((string)program_row[7].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFSPEED", id) + "，自定义速度填写有错误！");
}
return(false);
}
}
}
//自定义安全高度
float safeHeight = MotionPara.safeHeight;
if (program_row.Table.Columns.Count > 8)
{
if ((string)program_row[8].ToString() != "")
{
safeHeight = FloatConversion((string)program_row[8].ToString(), ref isRight);
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "BFHEIGHT", id) + "，自定义安全高度填写有错误！");
}
return(false);
}
}
}
//开始生成类数据
IList <IMotion> tempMotionList = new List <IMotion>();
//首先上升到安全高度
//New Class，世界坐标移动
BasicMotion _simpleMotion = new BasicMotion();
_simpleMotion.State = CurrentState.Active;
_simpleMotion.CurrentMotion = MotionType.WorldMove;
_simpleMotion.StartPos = firstObj.position;
_simpleMotion.StartEurler = firstObj.eulerAngles;
_simpleMotion.ParentTrans = firstObj;
_simpleMotion.ListCopy(childList, parentList);
//如果部件摆放的safeHeight对应的轴要改，修改这个参数
Vector3 motionVec = new Vector3(0f, safeHeight - _simpleMotion.StartPos.y, 0f);
_simpleMotion.EndPos = new Vector3(_simpleMotion.StartPos.x, safeHeight, _simpleMotion.StartPos.z);
_simpleMotion.EndEurler = _simpleMotion.StartEurler;
if (motionVec.magnitude == 0f)
{
_simpleMotion.StandardTime = 0.05f;
_simpleMotion.SpeedVector = new Vector3(0f, 0f, 0f);
}
else
{
_simpleMotion.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion.SpeedVector = motionVec / _simpleMotion.StandardTime;
}
_simpleMotion.EndTime = _simpleMotion.StandardTime / _simpleMotion.SpeedRate;
tempMotionList.Add(_simpleMotion);
//New Class---任意移动过度到目标位置上方
BasicMotion _simpleMotion2 = new BasicMotion();
_simpleMotion2.State = CurrentState.Future;
_simpleMotion2.CurrentMotion = MotionType.RandomMotion;
_simpleMotion2.StartPos = _simpleMotion.EndPos;
_simpleMotion2.StartEurler = _simpleMotion.EndEurler;
_simpleMotion2.ParentTrans = firstObj;
_simpleMotion2.ListCopy(childList, parentList);
_simpleMotion2.EndPos = new Vector3(finalPos.x, safeHeight, finalPos.z);
_simpleMotion2.EndEurler = finalEuler;
motionVec = _simpleMotion2.EndPos - _simpleMotion2.StartPos;
float moveTime = 0;
float rotateTime = 0;
moveTime = motionVec.magnitude / moveSpeed;
Vector3 angleDiff = GetAngleDiff(_simpleMotion2.StartEurler, ref _simpleMotion2.EndEurler);
rotateTime = Vector3.Angle(_simpleMotion2.StartEurler, _simpleMotion2.EndEurler) / MotionPara.toolRotateSpeed;
if (moveTime == 0 && rotateTime == 0)
{
_simpleMotion2.StandardTime = 0.05f;
_simpleMotion2.SpeedVector = Vector3.zero;
_simpleMotion2.AngleVector = Vector3.zero;
}
else if (moveTime > rotateTime)
{
_simpleMotion2.StandardTime = moveTime;
_simpleMotion2.SpeedVector = motionVec / moveTime;
_simpleMotion2.AngleVector = angleDiff / moveTime;
}
else
{
_simpleMotion2.StandardTime = rotateTime;
_simpleMotion2.SpeedVector = motionVec / rotateTime;
_simpleMotion2.AngleVector = angleDiff / rotateTime;
}
_simpleMotion2.EndTime = _simpleMotion2.StandardTime / _simpleMotion2.SpeedRate;
tempMotionList.Add(_simpleMotion2);
//New Class，下移到目标位置
BasicMotion _simpleMotion3 = new BasicMotion();
_simpleMotion3.State = CurrentState.Future;
_simpleMotion3.CurrentMotion = MotionType.WorldMove;
_simpleMotion3.StartPos = _simpleMotion2.EndPos;
_simpleMotion3.StartEurler = _simpleMotion2.EndEurler;
_simpleMotion3.ParentTrans = firstObj;
_simpleMotion3.ListCopy(childList, parentList);
_simpleMotion3.EndPos = finalPos;
_simpleMotion3.EndEurler = finalEuler;
motionVec = _simpleMotion3.EndPos - _simpleMotion3.StartPos;
if (motionVec.magnitude == 0f)
{
_simpleMotion3.StandardTime = 0.05f;
_simpleMotion3.SpeedVector = new Vector3(0f, 0f, 0f);
}
else
{
_simpleMotion3.StandardTime = motionVec.magnitude / moveSpeed;
_simpleMotion3.SpeedVector = motionVec / _simpleMotion3.StandardTime;
}
_simpleMotion3.EndTime = _simpleMotion3.StandardTime / _simpleMotion3.SpeedRate;
tempMotionList.Add(_simpleMotion3);
_complexMotionList.Add(tempMotionList);
return(true);
}
//铜棒敲击处理
private bool CopperHit(DataRow program_row, string id, DataTable group_table, IList <IMotion> _motionList,
IList <IList <IMotion> > _complexMotionList)
{
//铜棒运动时的父亲
GameObject empty = new GameObject();
empty.name = "copper_empty-" + id;
Transform copperTrans = null;
Transform firstObj = null;
// Transform firstObjParent = null;
List <Transform> parentList = new List <Transform>();
List <Transform> childList = new List <Transform>();
try{
//铜棒
copperTrans = GameObject.Find(MotionPara.copperName).transform;
}catch {
if (MotionPara.isEditor)
{
Debug.LogError(MotionPara.copperName + "：在此场景中未能找到铜棒！");
}
return(false);
}
bool isRight = true;
//Group Column
int groupColumn = IntConversion(program_row[3].ToString(), ref isRight) + 1;
if (!isRight)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "TBGROUP", id) + "，铜棒运动Group填写错误！");
}
return(false);
}
//运动物体信息
string objName = "";
try{
objName = (string)group_table.Rows[0][groupColumn].ToString();
firstObj = GameObject.Find(objName).transform;
// firstObjParent = firstObj.parent;
empty.transform.position = firstObj.position;
empty.transform.eulerAngles = firstObj.eulerAngles;
// firstObj.parent = empty.transform;
for (int i = 1; i < group_table.Rows.Count; i++)
{
objName = (string)group_table.Rows[i][groupColumn].ToString();
if (objName == "")
{
break;
}
Transform tempTrans = GameObject.Find(objName).transform;
childList.Add(tempTrans);
parentList.Add(tempTrans.parent);
// tempTrans.parent = empty.transform;
}
}catch {
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("PROGRAM", "TBGROUP", id) + "，Group号对应的Group表填写有错误！");
}
return(false);
}
//敲击次数
int copperTimes = IntConversion((string)program_row[4].ToString(), ref isRight);
if (!isRight || copperTimes == 0)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBTIMES", id) + "，铜棒敲击次数填写有错误！");
}
return(false);
}
//铜棒离敲击点距离
Vector3 disTBVec = Vector3Conversion((string)program_row[5].ToString(), ref isRight);
if (!isRight || disTBVec.magnitude == 0)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBDIS", id) + "，铜棒敲击距离填写有错误！");
}
return(false);
}
float disTB = disTBVec.magnitude; //铜棒移动距离
//物体移动方向
Vector3 dirTBVec = Vector3Conversion((string)program_row[6].ToString(), ref isRight);
if (!isRight || dirTBVec.magnitude == 0)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBDIR", id) + "，铜棒敲击物体移动方向填写有错误！");
}
return(false);
}
//移动速度确定
float copperHitSpeed = MotionPara.copperHitSpeed;
//检测是否有自定义速度
if (program_row.Table.Columns.Count > 7)
{
if ((string)program_row[7].ToString() != "")
{
copperHitSpeed = FloatConversion((string)program_row[7].ToString(), ref isRight);
if (!isRight || copperHitSpeed == 0)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBSPEED", id) + "，铜棒自定义速度填写有错误！");
}
return(false);
}
}
}
float copperBackSpeed = copperHitSpeed / 3f;
//铜棒敲击一次移动距离
float copperForwardDis = MotionPara.copperForwardDis;
//检测是否有自定义距离
if (program_row.Table.Columns.Count > 8)
{
if ((string)program_row[8].ToString() != "")
{
copperForwardDis = FloatConversion((string)program_row[8].ToString(), ref isRight);
if (!isRight || copperForwardDis == 0)
{
if (MotionPara.isEditor)
{
Debug.LogError(ErrorLocation.Locate("EXCEL", "TBFORWARDDIS", id) + "，铜棒自定义敲击移动距离填写有错误！");
}
return(false);
}
}
}
GameObject emptyPos = new GameObject();
emptyPos.name = "copper_empty_position--" + id;
//敲击类创建
IList <IMotion> tempMotionList = new List <IMotion>();
for (int i = 0; i < copperTimes; i++)
{
//铜棒敲击---New Class
BasicMotion _simpleMotion = new BasicMotion();
Vector3 motionVec = MotionPara.copperVector * (disTB + i * copperForwardDis);
_simpleMotion.CurrentMotion = MotionType.MoveOnly;
_simpleMotion.ParentTrans = copperTrans;
_simpleMotion.MoveSpeed = copperHitSpeed;
_simpleMotion.StandardTime = motionVec.magnitude / copperHitSpeed;
_simpleMotion.SpeedVector = motionVec / _simpleMotion.StandardTime;
//起始信息记录
_simpleMotion.StartPos = copperTrans.position;
_simpleMotion.StartEurler = copperTrans.eulerAngles;
emptyPos.transform.position = _simpleMotion.StartPos;
emptyPos.transform.eulerAngles = _simpleMotion.StartEurler;
emptyPos.transform.Translate(motionVec, Space.Self);
//终止信息记录
_simpleMotion.EndPos = emptyPos.transform.position;
_simpleMotion.EndEurler = emptyPos.transform.eulerAngles;
_simpleMotion.EndTime = _simpleMotion.StandardTime / _simpleMotion.SpeedRate;
if (i == 0)
{
_simpleMotion.State = CurrentState.Active;
}
else
{
_simpleMotion.State = CurrentState.Future;
}
tempMotionList.Add(_simpleMotion);
//被敲击物体瞬移---New Class
BasicMotion _simpleMotion2 = new BasicMotion();
_simpleMotion2.State = CurrentState.Future;
_simpleMotion2.CurrentMotion = MotionType.SetPos;
_simpleMotion2.ParentTrans = firstObj;
_simpleMotion2.ListCopy(childList, parentList);
//起始信息记录
emptyPos.transform.position = empty.transform.position;
emptyPos.transform.eulerAngles = empty.transform.eulerAngles;
_simpleMotion2.StartPos = emptyPos.transform.position;
_simpleMotion2.StartEurler = emptyPos.transform.eulerAngles;
emptyPos.transform.Translate(dirTBVec.normalized * (i + 1) * copperForwardDis, Space.Self);
//终止信息记录
_simpleMotion2.EndPos = emptyPos.transform.position;
_simpleMotion2.EndEurler = emptyPos.transform.eulerAngles;
//时间记录
_simpleMotion2.StandardTime = 0.05f;
_simpleMotion2.EndTime = 0.05f;
tempMotionList.Add(_simpleMotion2);
//铜棒返回---New Class
BasicMotion _simpleMotion3 = new BasicMotion();
_simpleMotion3.State = CurrentState.Future;
_simpleMotion3.CurrentMotion = MotionType.MoveOnly;
_simpleMotion3.ParentTrans = copperTrans;
_simpleMotion3.MoveSpeed = copperBackSpeed;
_simpleMotion3.StandardTime = motionVec.magnitude / copperBackSpeed;
_simpleMotion3.SpeedVector = -motionVec / _simpleMotion3.StandardTime;
//起始信息记录
_simpleMotion3.StartPos = _simpleMotion.EndPos;
_simpleMotion3.StartEurler = _simpleMotion.EndEurler;
//终止信息记录
_simpleMotion3.EndPos = _simpleMotion.StartPos;
_simpleMotion3.EndEurler = _simpleMotion.StartEurler;
_simpleMotion3.EndTime = _simpleMotion3.StandardTime / _simpleMotion3.SpeedRate;
tempMotionList.Add(_simpleMotion3);
}
_complexMotionList.Add(tempMotionList);
GameObject.DestroyImmediate(emptyPos);
GameObject.DestroyImmediate(empty);
return(true);
}