using System;
using System.Collections.Generic;
using UnityEngine;
using UnityEngine.UI;
using ArduinoBluetoothAPI;

public class BluetoothNew : MonoBehaviour
{
    BluetoothHelper bluetoothHelper;
    BluetoothHelperCharacteristic characteristicWrite;
    BluetoothHelperService bluetoothService;
    string deviceName = "";
    bool canConnect = true;

    [SerializeField] string targetDeviceName = "BGBox_202012";
    [SerializeField] Text textUI;

    void OnDestroy()
    {
        if (bluetoothHelper != null)
        {
            bluetoothHelper.Disconnect();
        }
    }

    void FixedUpdate()
    {
        Connect();
    }

    void Connect()
    {
        if (!canConnect)
        {
            return;
        }
        canConnect = false;
        try
        {
            BluetoothHelper.BLE = true;
            bluetoothHelper = BluetoothHelper.GetNewInstance();

            bluetoothHelper.OnConnected += (BluetoothHelper helper) =>
            {
                Log("连接成功\n" + helper.getDeviceName());
                foreach (BluetoothHelperService service in helper.getGattServices())
                {
                  
                    if (service.getName().ToLower().StartsWith("0000fff0"))
                    {
                        bluetoothService = service;

                        foreach (BluetoothHelperCharacteristic characteristic in service.getCharacteristics())
                        {
                            if (characteristic.getName().ToLower().StartsWith("0000fff2"))
                            {
                                characteristicWrite = characteristic;
                            }
                            else if (characteristic.getName().ToLower().StartsWith("0000fff1"))
                            {

                                BluetoothHelperCharacteristic ch = new BluetoothHelperCharacteristic(characteristic.getName());
                                ch.setService(bluetoothService.getName());
                                bluetoothHelper.Subscribe(ch);
                            }
                        }
                    }
                }
                Invoke("OpenReceiveData", 2);
                Invoke("SetReceiveDataInterval20", 4);
            };
            bluetoothHelper.OnConnectionFailed += (BluetoothHelper helper) =>
            {
                canConnect = true;
                Log("连接失败\n" + helper.getDeviceName());
            };
            bluetoothHelper.OnCharacteristicChanged += (helper, value, characteristic) =>
            {
                byte[] bytes = value;
                BluetoothClient.UploadData(bytes);
                if (BluetoothClient.onDataReceived != null)
                {
                    BluetoothClient.onDataReceived(bytes);
                }
            };
            bluetoothHelper.OnScanEnded += (BluetoothHelper helper, LinkedList<BluetoothDevice> nearbyDevices) =>
            {
                foreach (BluetoothDevice device in nearbyDevices)
                {
                    if (device.DeviceName == targetDeviceName)
                    {
                        deviceName = device.DeviceName;
                        bluetoothHelper.setDeviceName(deviceName);
                        bluetoothHelper.Connect();
                        Log("发现设备\n" + device.DeviceName);
                        return;
                    }
                }
                canConnect = true;
                Log("没有发现设备");
            };

            bluetoothHelper.ScanNearbyDevices();
            Log("正在扫描设备");
        }
        catch (Exception e)
        {
            Debug.Log(e.Message);
            canConnect = true;
            Log("请打开蓝牙");
        }
    }

    void OpenReceiveData()
    {
        BluetoothHelperCharacteristic ch = new BluetoothHelperCharacteristic(characteristicWrite.getName());
        ch.setService(bluetoothService.getName());
        bluetoothHelper.WriteCharacteristic(ch, "3");
        Log("开始接收信息\n" + deviceName);
    }

    void SetReceiveDataInterval20()
    {
        bluetoothHelper.WriteCharacteristic(characteristicWrite, "b");
        Log("修改接收频率\n" + deviceName);
    }

    float ToAcceleratedSpeed(byte b1, byte b2)
    {
        int value = TwoByteToInt(b1, b2);
        return (float)value / 32768 * 16;
    }

    int TwoByteToInt(byte b1, byte b2)
    {
        ushort twoByte = (ushort)(b1 * 256 + b2);
        short shortNum = (short)twoByte;
        return (int)shortNum;
    }

    void Log(string text)
    {
        if (textUI != null) 
        {
            textUI.text = text;
        }
    }
}