joystick
This commit is contained in:
Binary file not shown.
Binary file not shown.
Binary file not shown.
+50
-1
@@ -10514,6 +10514,55 @@ Transform:
|
|||||||
m_Father: {fileID: 920748677}
|
m_Father: {fileID: 920748677}
|
||||||
m_RootOrder: 2
|
m_RootOrder: 2
|
||||||
m_LocalEulerAnglesHint: {x: 0, y: 0, z: 0}
|
m_LocalEulerAnglesHint: {x: 0, y: 0, z: 0}
|
||||||
|
--- !u!1 &73925798
|
||||||
|
GameObject:
|
||||||
|
m_ObjectHideFlags: 0
|
||||||
|
m_PrefabParentObject: {fileID: 0}
|
||||||
|
m_PrefabInternal: {fileID: 0}
|
||||||
|
serializedVersion: 5
|
||||||
|
m_Component:
|
||||||
|
- component: {fileID: 73925799}
|
||||||
|
- component: {fileID: 73925800}
|
||||||
|
m_Layer: 0
|
||||||
|
m_Name: SerialIn
|
||||||
|
m_TagString: Untagged
|
||||||
|
m_Icon: {fileID: 0}
|
||||||
|
m_NavMeshLayer: 0
|
||||||
|
m_StaticEditorFlags: 0
|
||||||
|
m_IsActive: 1
|
||||||
|
--- !u!4 &73925799
|
||||||
|
Transform:
|
||||||
|
m_ObjectHideFlags: 0
|
||||||
|
m_PrefabParentObject: {fileID: 0}
|
||||||
|
m_PrefabInternal: {fileID: 0}
|
||||||
|
m_GameObject: {fileID: 73925798}
|
||||||
|
m_LocalRotation: {x: 0, y: 0, z: 0, w: 1}
|
||||||
|
m_LocalPosition: {x: -43.539, y: -46.55305, z: -15.30658}
|
||||||
|
m_LocalScale: {x: 1, y: 1, z: 1}
|
||||||
|
m_Children: []
|
||||||
|
m_Father: {fileID: 0}
|
||||||
|
m_RootOrder: 5
|
||||||
|
m_LocalEulerAnglesHint: {x: 0, y: 0, z: 0}
|
||||||
|
--- !u!114 &73925800
|
||||||
|
MonoBehaviour:
|
||||||
|
m_ObjectHideFlags: 0
|
||||||
|
m_PrefabParentObject: {fileID: 0}
|
||||||
|
m_PrefabInternal: {fileID: 0}
|
||||||
|
m_GameObject: {fileID: 73925798}
|
||||||
|
m_Enabled: 1
|
||||||
|
m_EditorHideFlags: 0
|
||||||
|
m_Script: {fileID: 11500000, guid: 7fa025fa8dcb3a249b67fc0e2fe67b44, type: 3}
|
||||||
|
m_Name:
|
||||||
|
m_EditorClassIdentifier:
|
||||||
|
bot: {fileID: 311513962}
|
||||||
|
walk: {fileID: 311513965}
|
||||||
|
a1: 0
|
||||||
|
a2: 0
|
||||||
|
a3: 0
|
||||||
|
b1: 0
|
||||||
|
b2: 0
|
||||||
|
b3: 0
|
||||||
|
enabled: 0
|
||||||
--- !u!1 &74230589
|
--- !u!1 &74230589
|
||||||
GameObject:
|
GameObject:
|
||||||
m_ObjectHideFlags: 0
|
m_ObjectHideFlags: 0
|
||||||
@@ -48816,7 +48865,7 @@ MonoBehaviour:
|
|||||||
speed2: 10
|
speed2: 10
|
||||||
walkDirection: 0
|
walkDirection: 0
|
||||||
centerRotation: 0
|
centerRotation: 0
|
||||||
walkspeed: 2
|
walkspeed: 0
|
||||||
--- !u!1 &311874317
|
--- !u!1 &311874317
|
||||||
GameObject:
|
GameObject:
|
||||||
m_ObjectHideFlags: 0
|
m_ObjectHideFlags: 0
|
||||||
|
|||||||
@@ -0,0 +1,69 @@
|
|||||||
|
using System;
|
||||||
|
using UnityEngine;
|
||||||
|
using System.Collections;
|
||||||
|
using System.IO.Ports;
|
||||||
|
using System.Linq;
|
||||||
|
|
||||||
|
public class Serial2 : MonoBehaviour{
|
||||||
|
|
||||||
|
public float x;
|
||||||
|
public float y;
|
||||||
|
|
||||||
|
public RotationControl bot;
|
||||||
|
|
||||||
|
~Serial2() {
|
||||||
|
serialPort.Close();
|
||||||
|
}
|
||||||
|
|
||||||
|
public bool enabled = false;
|
||||||
|
|
||||||
|
SerialPort serialPort;
|
||||||
|
|
||||||
|
public void Update()
|
||||||
|
{
|
||||||
|
if (serialPort == null)
|
||||||
|
{
|
||||||
|
serialPort = new SerialPort(@"\\.\" + "COM7", 115200);
|
||||||
|
|
||||||
|
try
|
||||||
|
{
|
||||||
|
serialPort.NewLine = "\n";
|
||||||
|
|
||||||
|
serialPort.Open();
|
||||||
|
serialPort.DiscardOutBuffer();
|
||||||
|
serialPort.DiscardInBuffer();
|
||||||
|
|
||||||
|
enabled = true;
|
||||||
|
}
|
||||||
|
catch
|
||||||
|
{
|
||||||
|
enabled = false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (enabled)
|
||||||
|
{
|
||||||
|
if (serialPort is SerialPort)
|
||||||
|
{
|
||||||
|
string received = serialPort.ReadLine();
|
||||||
|
string[] data = received.Split(',');
|
||||||
|
x = ConvertRadiansToDegrees(float.Parse(data.First()));
|
||||||
|
y = ConvertRadiansToDegrees(float.Parse(data.Last()));
|
||||||
|
|
||||||
|
bot.rotation = new Quaternion(-1* limit(y, -30, 30), 0, -1* limit(x, -30, 30), 1);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
public float limit(float input, float min, float max)
|
||||||
|
{
|
||||||
|
return (input < max & input > min) ? input : input < min ? min : max;
|
||||||
|
}
|
||||||
|
|
||||||
|
public float ConvertRadiansToDegrees(float radians)
|
||||||
|
{
|
||||||
|
float degrees = (float) ((180 / Math.PI) * radians);
|
||||||
|
return (degrees);
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
@@ -0,0 +1,13 @@
|
|||||||
|
fileFormatVersion: 2
|
||||||
|
guid: ac6468bb4d2734947a923ea42d6d8192
|
||||||
|
timeCreated: 1557262171
|
||||||
|
licenseType: Free
|
||||||
|
MonoImporter:
|
||||||
|
externalObjects: {}
|
||||||
|
serializedVersion: 2
|
||||||
|
defaultReferences: []
|
||||||
|
executionOrder: 0
|
||||||
|
icon: {instanceID: 0}
|
||||||
|
userData:
|
||||||
|
assetBundleName:
|
||||||
|
assetBundleVariant:
|
||||||
@@ -0,0 +1,160 @@
|
|||||||
|
using System;
|
||||||
|
using UnityEngine;
|
||||||
|
using System.Collections;
|
||||||
|
using System.IO.Ports;
|
||||||
|
using System.Linq;
|
||||||
|
using UnityEngine.UI;
|
||||||
|
|
||||||
|
public class Serial3 : MonoBehaviour{
|
||||||
|
|
||||||
|
public RotationControl bot;
|
||||||
|
public Walk3 walk;
|
||||||
|
|
||||||
|
public float a1, a2, a3, b1, b2, b3;
|
||||||
|
|
||||||
|
~Serial3() {
|
||||||
|
serialPort.Close();
|
||||||
|
}
|
||||||
|
|
||||||
|
public bool enabled = false;
|
||||||
|
|
||||||
|
SerialPort serialPort;
|
||||||
|
|
||||||
|
public void Update()
|
||||||
|
{
|
||||||
|
if (serialPort == null)
|
||||||
|
{
|
||||||
|
serialPort = new SerialPort(@"\\.\" + "COM7", 115200);
|
||||||
|
|
||||||
|
try
|
||||||
|
{
|
||||||
|
serialPort.NewLine = "\r\n";
|
||||||
|
|
||||||
|
// serialPort.DataReceived += new SerialDataReceivedEventHandler(DataReceivedHandler);
|
||||||
|
|
||||||
|
serialPort.Open();
|
||||||
|
serialPort.DiscardOutBuffer();
|
||||||
|
serialPort.DiscardInBuffer();
|
||||||
|
|
||||||
|
enabled = true;
|
||||||
|
}
|
||||||
|
catch
|
||||||
|
{
|
||||||
|
enabled = false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (enabled)
|
||||||
|
{
|
||||||
|
if (serialPort is SerialPort)
|
||||||
|
{
|
||||||
|
string received = serialPort.ReadLine();
|
||||||
|
string[] data = received.Split(',');
|
||||||
|
|
||||||
|
foreach (string d in data)
|
||||||
|
{
|
||||||
|
|
||||||
|
string[] ch = d.Split('_');
|
||||||
|
|
||||||
|
int channel = int.Parse(ch.First());
|
||||||
|
float value = float.Parse(ch.Last());
|
||||||
|
|
||||||
|
switch (channel)
|
||||||
|
{
|
||||||
|
case 0:
|
||||||
|
a1 = value - 127;
|
||||||
|
break;
|
||||||
|
case 1:
|
||||||
|
a2 = value - 127;
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
a3 = value - 127;
|
||||||
|
break;
|
||||||
|
case 3:
|
||||||
|
b1 = value - 127;
|
||||||
|
break;
|
||||||
|
case 4:
|
||||||
|
b2 = value - 127;
|
||||||
|
break;
|
||||||
|
case 5:
|
||||||
|
b3 = value - 127;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
bot.rotation = new Quaternion(limit(a2, -20, 20), -1 * limit(a3, -20, 20), -1 * limit(a1, -20, 20),
|
||||||
|
1);
|
||||||
|
|
||||||
|
float speed = (float) (Math.Sqrt(b1 * b1 + b2 * b2) / 127) * 3;
|
||||||
|
walk.walkspeed = speed < 0.5f ? 0 : speed;
|
||||||
|
|
||||||
|
float rotation = -1 * limit(b3/4, -5, 5);
|
||||||
|
walk.centerRotation = rotation < 0.5f && rotation > -0.5f ? 0 : rotation;
|
||||||
|
|
||||||
|
walk.walkDirection = (-1 * ConvertRadiansToDegrees((float) Math.Atan2(b2, b1)));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
private void DataReceivedHandler(object sender, SerialDataReceivedEventArgs e)
|
||||||
|
{
|
||||||
|
SerialPort serialPort = (SerialPort)sender;
|
||||||
|
|
||||||
|
if (enabled)
|
||||||
|
{
|
||||||
|
if (serialPort is SerialPort)
|
||||||
|
{
|
||||||
|
string received = serialPort.ReadLine();
|
||||||
|
string[] data = received.Split(',');
|
||||||
|
|
||||||
|
foreach (string d in data)
|
||||||
|
{
|
||||||
|
// if (data == "\r")
|
||||||
|
// continue;
|
||||||
|
|
||||||
|
string[] ch = d.Split('_');
|
||||||
|
|
||||||
|
int channel = int.Parse(ch.First());
|
||||||
|
float value = float.Parse(ch.Last());
|
||||||
|
|
||||||
|
switch (channel)
|
||||||
|
{
|
||||||
|
case 0:
|
||||||
|
a1 = value;
|
||||||
|
break;
|
||||||
|
case 1:
|
||||||
|
a2 = value;
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
a3 = value;
|
||||||
|
break;
|
||||||
|
case 3:
|
||||||
|
b1 = value;
|
||||||
|
break;
|
||||||
|
case 4:
|
||||||
|
b2 = value;
|
||||||
|
break;
|
||||||
|
case 5:
|
||||||
|
b3 = value;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// bot.rotation = new Quaternion(-1* limit(y, -30, 30), 0, -1* limit(x, -30, 30), 1);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
public float limit(float input, float min, float max)
|
||||||
|
{
|
||||||
|
input = input / 6;
|
||||||
|
return (input < max & input > min) ? input : input < min ? min : max;
|
||||||
|
}
|
||||||
|
|
||||||
|
public float ConvertRadiansToDegrees(float radians)
|
||||||
|
{
|
||||||
|
float degrees = (float)((180 / Math.PI) * radians);
|
||||||
|
return (degrees);
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
@@ -0,0 +1,13 @@
|
|||||||
|
fileFormatVersion: 2
|
||||||
|
guid: 7fa025fa8dcb3a249b67fc0e2fe67b44
|
||||||
|
timeCreated: 1558207463
|
||||||
|
licenseType: Free
|
||||||
|
MonoImporter:
|
||||||
|
externalObjects: {}
|
||||||
|
serializedVersion: 2
|
||||||
|
defaultReferences: []
|
||||||
|
executionOrder: 0
|
||||||
|
icon: {instanceID: 0}
|
||||||
|
userData:
|
||||||
|
assetBundleName:
|
||||||
|
assetBundleVariant:
|
||||||
Reference in New Issue
Block a user