sem/Proftaak-RH-B4
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

wip

Browse Source
This commit is contained in:
shinichi
2020-09-09 17:09:08 +02:00
parent 11772f33b7
commit 2854684b86
3 changed files with 170 additions and 124 deletions
Download Patch File Download Diff File Expand all files Collapse all files

238
ProftaakRH/FietsDemo.cs
View File

@@ -4,149 +4,155 @@ using System.Collections.Generic;
using System.Text;
using System.Threading;
using System.Threading.Tasks;
using Hardware.Simulators;
using Hardware;
namespace FietsDemo
{
internal class Program
{
//static void Main(string[] args)
//{
// foo foo = new foo();
// BLEReceiver bLEReceiver = new BLEReceiver(foo);
// bLEReceiver.ConnectToBLE();
// Console.Read();
//}
interface IFoo
private static async Task Main(string[] args)
{
void doStuff(byte[] bytes);
int errorCode = 0;
BLE bleBike = new BLE();
BLE bleHeart = new BLE();
Thread.Sleep(1000); // We need some time to list available devices
// List available devices
List<String> bleBikeList = bleBike.ListDevices();
Console.WriteLine("Devices found: ");
foreach (var name in bleBikeList)
{
Console.WriteLine($"Device: {name}");
}
// Connecting
errorCode = errorCode = await bleBike.OpenDevice("Avans Bike AC48");
// __TODO__ Error check
var services = bleBike.GetServices;
foreach (var service in services)
{
Console.WriteLine($"Service: {service}");
}
// Set service
errorCode = await bleBike.SetService("6e40fec1-b5a3-f393-e0a9-e50e24dcca9e");
// __TODO__ error check
// Subscribe
bleBike.SubscriptionValueChanged += BleBike_SubscriptionValueChanged;
errorCode = await bleBike.SubscribeToCharacteristic("6e40fec2-b5a3-f393-e0a9-e50e24dcca9e");
// Heart rate
errorCode = await bleHeart.OpenDevice("Avans Bike AC48");
await bleHeart.SetService("HeartRate");
bleHeart.SubscriptionValueChanged += BleBike_SubscriptionValueChanged;
await bleHeart.SubscribeToCharacteristic("HeartRateMeasurement");
Console.Read();
}
class BLEReceiver
private static void BleBike_SubscriptionValueChanged(object sender, BLESubscriptionValueChangedEventArgs e)
{
IFoo foo;
//Console.WriteLine("Received from {0}: {1}, {2}", e.ServiceName,
// BitConverter.ToString(e.Data).Replace("-", " "),
// Encoding.UTF8.GetString(e.Data));
public BLEReceiver(IFoo foo)
string[] bytes = BitConverter.ToString(e.Data).Split('-');
string[] ANT = new string[5];
if (e.ServiceName == "6e40fec2-b5a3-f393-e0a9-e50e24dcca9e")
{
this.foo = foo;
}
//Console.WriteLine("SYNC : " + bytes[0]);
//ANT[0] = bytes[0];
//Console.WriteLine("LENGTH : " + bytes[1]);
public async void ConnectToBLE()
{
int errorCode = 0;
BLE bleBike = new BLE();
BLE bleHeart = new BLE();
Thread.Sleep(1000); // We need some time to list available devices
// List available devices
List<String> bleBikeList = bleBike.ListDevices();
Console.WriteLine("Devices found: ");
foreach (var name in bleBikeList)
{
Console.WriteLine($"Device: {name}");
}
// Connecting
errorCode = errorCode = await bleBike.OpenDevice("Avans Bike AC48");
// __TODO__ Error check
var services = bleBike.GetServices;
foreach (var service in services)
{
Console.WriteLine($"Service: {service}");
}
// Set service
errorCode = await bleBike.SetService("6e40fec1-b5a3-f393-e0a9-e50e24dcca9e");
// __TODO__ error check
// Subscribe
bleBike.SubscriptionValueChanged += BleBike_SubscriptionValueChanged;
errorCode = await bleBike.SubscribeToCharacteristic("6e40fec2-b5a3-f393-e0a9-e50e24dcca9e");
// Heart rate
errorCode = await bleHeart.OpenDevice("Avans Bike AC48");
await bleHeart.SetService("HeartRate");
bleHeart.SubscriptionValueChanged += BleBike_SubscriptionValueChanged;
await bleHeart.SubscribeToCharacteristic("HeartRateMeasurement");
Console.Read();
}
private void BleBike_SubscriptionValueChanged(object sender, BLESubscriptionValueChangedEventArgs e)
{
//Console.WriteLine("Received from {0}: {1}, {2}", e.ServiceName,
// BitConverter.ToString(e.Data).Replace("-", " "),
// Encoding.UTF8.GetString(e.Data));
//string[] bytes = BitConverter.ToString(e.Data).Split('-');
//string[] ANT = new string[5];
//if (e.ServiceName == "6e40fec2-b5a3-f393-e0a9-e50e24dcca9e")
int length = Convert.ToInt32(bytes[1], 16);
//ANT[1] = length.ToString();
//Console.WriteLine("MSG ID : " + bytes[2]);
//ANT[2] = bytes[2];
//string msg = string.Empty;
//for (int i = 3; i < 3 + length; i++)
//{
// Console.WriteLine("SYNC : " + bytes[0]);
// ANT[0] = bytes[0];
// Console.WriteLine("LENGTH : " + bytes[1]);
// int length = Convert.ToInt32(bytes[1], 16);
// ANT[1] = length.ToString();
// Console.WriteLine("MSG ID : " + bytes[2]);
// ANT[2] = bytes[2];
// string msg = string.Empty;
// for (int i = 3; i < 3 + length; i++)
// {
// msg += bytes[i];
// }
// ANT[3] = msg;
// byte[] message = new byte[length];
// Array.Copy(e.Data, 3, message, 0, length);
// DoCrazyShitWithMsg(message);
// Console.WriteLine("MSG : " + msg);
// string checksum = bytes[3 + length];
// ANT[4] = checksum;
// Console.WriteLine("CHECKSUM : " + checksum);
// Console.WriteLine(BitConverter.ToString(e.Data));
// msg += bytes[i];
//}
//else
//ANT[3] = msg;
byte[] message = new byte[length - 1];
Array.Copy(e.Data, 4, message, 0, length - 1);
DoCrazyShitWithMsg(message);
//Console.WriteLine("MSG : " + msg);
//string checksum = bytes[3 + length];
//ANT[4] = checksum;
//Console.WriteLine("CHECKSUM : " + checksum);
//byte calcChecksum = 0;
//for (int i = 0; i < e.Data.Length - 1; i++)
//{
// Console.WriteLine("BPM: " + Convert.ToInt32(bytes[1], 16));
// calcChecksum ^= e.Data[i];
//}
//Console.WriteLine();
this.foo.doStuff(e.Data);
//Console.WriteLine("Calculated checksum : " + Convert.ToString(calcChecksum,16).ToUpper());
//Console.WriteLine(BitConverter.ToString(e.Data));
}
private static void DoCrazyShitWithMsg(byte[] bytes)
else
{
String[] hexvalues = BitConverter.ToString(bytes).Split('-');
for (int i = 0; i < hexvalues.Length; i++)
{
Console.WriteLine("Byte {0}: {1}", i, hexvalues[i]);
}
//Console.WriteLine("BPM: " + Convert.ToInt32(bytes[1], 16));
}
Console.WriteLine();
}
class foo : IFoo
private static void DoCrazyShitWithMsg(byte[] bytes)
{
public void doStuff(byte[] bytes)
Console.WriteLine("doing crazy shit with {0}", bytes);
String[] hexvalues = BitConverter.ToString(bytes).Split('-');
for (int i = 0; i < hexvalues.Length; i++)
{
Console.WriteLine("Byte {0}: {1}", i, hexvalues[i]);
}
switch (bytes[0])
{
case 0x10:
Console.WriteLine();
Console.WriteLine("Data Page Number\t\t: " + hexvalues[0]);
Console.WriteLine("Equipment Type Bit Field\t: " + hexvalues[1]);
Console.WriteLine("Elapsed Time\t\t\t: " + hexvalues[2]);
Console.WriteLine("Distance Traveled\t\t: " + hexvalues[3]);
Console.WriteLine("Speed LSB\t\t\t: " + hexvalues[4]);
Console.WriteLine("Speed LSB\t\t\t: " + hexvalues[5]);
Console.WriteLine("Heart Rate\t\t\t: " + hexvalues[6]);
Console.WriteLine("Capabilities FE State Bit Field\t: " + Convert.ToString(bytes[7], 2));
break;
case 0x19:
Console.WriteLine();
Console.WriteLine("Data Page Number\t\t: " + hexvalues[0]);
Console.WriteLine("Update Event Count\t\t: " + hexvalues[1]);
Console.WriteLine("Instantaneous Cadence\t\t: " + hexvalues[2]);
Console.WriteLine("Accumulated Power LSB\t\t: " + hexvalues[3]);
Console.WriteLine("Accumulated Power MSB\t\t: " + hexvalues[4]);
Console.WriteLine("Instant Power LSB\t\t: " + hexvalues[5]);
Console.WriteLine("Instant Power MSN and status\t: " + Convert.ToString(bytes[6], 2));
Console.WriteLine("Flags and FE state BitField\t: " + Convert.ToString(bytes[7], 2));
break;
default:
Console.WriteLine("data page number not recognized");
break;
Console.WriteLine("Foo class received {0}", Convert.ToString(bytes));
}
//Console.WriteLine("Speed might be {0} m/s", bytes[3] * 0.093294);
}
}
}