using UnityEngine; using System.Collections; using System.Collections.Generic; using ANT_Managed_Library; using System; public class SpeedDisplay : MonoBehaviour { public bool autoStartScan = true; //start scan on play public bool connected = false; //will be set to true once connected public float wheelCircumference = 2.096f; //700*23C, set this to your wheels size //windows and mac settings public bool autoConnectToFirstSensorFound = true; //for windows and mac, either connect to the first sensor found or let you pick a sensor manually in the scanResult list with your own UI and call ConnectToDevice(AntDevice device) public List scanResult; //android settings public bool useAndroidUI = true; //will open the unified ant+ UI on the android app if set to true, otherwise will connect to the first found device public bool skipPreferredSearch = true; //- True = Don't automatically connect to user's preferred device, but always go to search for other devices. //the sensor values we receive fron the onReceiveData event public float speed; // The speed in km/h public float distance; //the distance in meters private AntChannel backgroundScanChannel; private AntChannel deviceChannel; private int stopRevCounter_speed = 0; private int prev_measTime_speed = 0; private int prev_revCount_speed = 0; private int revCountZero = 0; public int deviceID = 0; //set this to connect to a specific device ID void Start() { if (autoStartScan) StartScan(); } //Start a background Scan to find the device public void StartScan() { Debug.Log("Looking for ANT + Speed sensor"); #if UNITY_ANDROID && !UNITY_EDITOR //java: connect_speed(String gameobjectName, float wheel, boolean useAndroidUI, boolean skipPreferredSearch, int deviceID) AndroidJNI.AttachCurrentThread(); using (AndroidJavaClass javaClass = new AndroidJavaClass("com.ant.plugin.Ant_Connector")) { using (AndroidJavaObject activity = javaClass.GetStatic("mContext")) { activity.Call("connect_speed", this.gameObject.name, wheelCircumference,useAndroidUI, skipPreferredSearch,deviceID); } } #else AntManager.Instance.Init(); scanResult = new List(); backgroundScanChannel = AntManager.Instance.OpenBackgroundScanChannel(0); backgroundScanChannel.onReceiveData += ReceivedBackgroundScanData; #endif } //Android function void ANTPLUG_ConnectEvent(string resultCode) { switch (resultCode) { case "SUCCESS": connected = true; break; case "CHANNEL_NOT_AVAILABLE": //Channel Not Available break; case "ADAPTER_NOT_DETECTED": //ANT Adapter Not Available. Built-in ANT hardware or external adapter required. Debug.Log("ANT Adapter Not Available. Built-in ANT hardware or external adapter required."); break; case "BAD_PARAMS": //Bad request parameters. break; case "OTHER_FAILUR": //RequestAccess failed. See logcat for details. break; case "DEPENDENCY_NOT_INSTALLED": //You need to install the ANT+ Plugins service or you may need to update your existing version if you already have it. case "USER_CANCELLED": //USER_CANCELLED break; case "UNRECOGNIZED": //UNRECOGNIZED. PluginLib Upgrade Required?", break; default: //UNRECOGNIZED break; } } void ANTPLUG_StateChange(string newDeviceState) { switch (newDeviceState) { case "DEAD": connected = false; break; case "CLOSED": break; case "SEARCHING": //searching break; case "TRACKING": //tracking break; case "PROCESSING_REQUEST": break; default: //UNRECOGNIZED break; } } void ANTPLUG_Receive_calculatedSpeed(string s) { speed = float.Parse(s) *3.6f; } void ANTPLUG_Receive_CalculatedAccumulatedDistance(string s) { distance = float.Parse(s); } //Windows and mac //If the device is found void ReceivedBackgroundScanData(Byte[] data) { byte deviceType = (data[12]); // extended info Device Type byte switch (deviceType) { case AntplusDeviceType.BikeSpeed: { int deviceNumber = (data[10]) | data[11] << 8; byte transType = data[13]; foreach (AntDevice d in scanResult) { if (d.deviceNumber == deviceNumber && d.transType == transType) //device already found return; } Debug.Log("Speed sensor found " + deviceNumber); AntDevice foundDevice = new AntDevice(); foundDevice.deviceType = deviceType; foundDevice.deviceNumber = deviceNumber; foundDevice.transType = transType; foundDevice.period = 8118; foundDevice.radiofreq = 57; foundDevice.name = "BikeSpeed(" + foundDevice.deviceNumber+")"; scanResult.Add(foundDevice); if (autoConnectToFirstSensorFound) { ConnectToDevice(foundDevice); } break; } default: { break; } } } void ConnectToDevice(AntDevice device) { AntManager.Instance.CloseBackgroundScanChannel(); byte channelID = AntManager.Instance.GetFreeChannelID(); deviceChannel = AntManager.Instance.OpenChannel(ANT_ReferenceLibrary.ChannelType.BASE_Slave_Receive_0x00, channelID, (ushort)device.deviceNumber,device.deviceType, device.transType, (byte)device.radiofreq, (ushort)device.period, false); connected = true; deviceChannel.onReceiveData += Data; deviceChannel.onChannelResponse += ChannelResponse; deviceChannel.hideRXFAIL = true; } //Deal with the received Data public void Data(Byte[] data) { //SPEED int measTime_speed = (data[4]) | data[5] << 8; int revCount_speed = (data[6]) | data[7] << 8; if (prev_measTime_speed != 0 && measTime_speed != prev_measTime_speed && prev_measTime_speed < measTime_speed && prev_revCount_speed < revCount_speed) { speed = (wheelCircumference * (revCount_speed - prev_revCount_speed) * 1024) / (measTime_speed - prev_measTime_speed); speed *= 3.6f; // km/h stopRevCounter_speed = 0; } else stopRevCounter_speed++; if (stopRevCounter_speed >= 5) { stopRevCounter_speed = 5; speed = 0; } prev_measTime_speed = measTime_speed; prev_revCount_speed = revCount_speed; //DISTANCE if (revCountZero == 0) revCountZero = revCount_speed; distance = wheelCircumference * (revCount_speed - revCountZero); } void ChannelResponse(ANT_Response response) { } }