using System;
using System.Threading;

namespace ConsoleApplication10
{
class Program
{
static void Main(string[] args)
{
RoboticsConnection.Serializer.Serializer serializer = new RoboticsConnection.Serializer.Serializer();
serializer.BaudRate = 19200;
serializer.PortName = "COM5";
serializer.Units = RoboticsConnection.Serializer.Ids.Units.Metric;

serializer.StartCommunication();

//Make the I/O pin an Output
//Bring LOW the pin that the PING rangefinder is connected
//Bring the pin HIGH for 5 microseconds
//Bring the pin LOW
//Make the I/O pin an Input
//Wait until the pin goes HIGH
//Use a timer to see how much longer it takes for the pin to become LOW
//The time it took to become low is now our raw distance ( in microseconds)
//Divide Raw Distance by two since it includes the time for a return trip of the sonar
//Raw distance * 2257 is our distance in cm
//Raw distance * 889 is our distance in inches

// 0 = output low
// 1 = output high
// 2 = input

RoboticsConnection.Serializer.Sensors.I2CDevice iowizard = new RoboticsConnection.Serializer.Sensors.I2CDevice(serializer);
string result = string.Empty;

result = iowizard.Write(0x64, "1 0 0");
Console.WriteLine(result);

result = iowizard.Write(0x64, "1 0 1");
Console.WriteLine(result);

result = iowizard.Write(0x64, "1 0 0");
Console.WriteLine(result);

result = iowizard.Write(0x64, "1 0 2");
Console.WriteLine(result);

for (int i = 0; i < 100; i++)
{
result = iowizard.Read(0x64, "20");
Console.WriteLine(result);
Thread.Sleep(100);
}

serializer.StopCommunication();
}
}
}