Files
Hexapod_Simulation_Unity/Assets/Walk2.cs
T
2018-11-14 22:22:38 +01:00

104 lines
2.4 KiB
C#

using System.Collections;
using System.Collections.Generic;
using UnityEngine;
public class Walk2 : MonoBehaviour
{
public List<GameObject> legs = new List<GameObject>();
private List<Vector3> legsInitial = new List<Vector3>();
// Use this for initialization
void Start()
{
for (int index = 0; index < legs.Count; ++index)
{
legsInitial.Add(legs[index].GetComponent<Leg>().point);
}
}
struct step
{
public float rotation;
public float height;
public bool inAir;
public step(float r, float h, bool i)
{
rotation = r;
height = h;
inAir = i;
}
}
// 1, 3, 5 -= 3
int offset(int i, int offset, int max)
{
return i - offset < 0 ? (max - (offset - i)) : i - offset;
}
step[] s = {
new step(-1, 0, false),
new step(0, -2, false),
new step(0, 0, false), // rest
new step(1, 0, false),
new step(1, 0, false),
new step(0, 0, false), // rest
new step(0, 2, false),
new step(-1, 0, true),
};
public int st = 5;
public int speed2 = 30;
int speed = 10;
public float rotation = 0;
int size = 8;
//public float walkspeed = 1;
// Update is called once per frame
void FixedUpdate()
{
if (speed <= 0)
{
if (st >= size-1)
st = 0;
else
st++;
for (int index = 0; index < legs.Count; ++index)
{
int t = st;
if (index == 1 || index == 3 || index == 5)
{
t = offset(st, 4, size);
}
if (s[t].inAir == false)
{
Vector3 n = legs[index].GetComponent<Leg>().getWorldPos();
n = Quaternion.Euler(0, rotation * s[t].rotation, 0) * n;
n.y += s[t].height;
// rotate x,y around rotation.
legs[index].GetComponent<Leg>().setWorldPos(n);
}
else
{
legs[index].GetComponent<Leg>().point = legsInitial[index] + new Vector3(0, s[t].height, 0);
}
}
speed = speed2;
}
else
speed--;
}
}