public UltraSonicSensor(Cpu.Pin echoPin, Cpu.Pin triggerPin)
{
_echoPin = new InterruptPort(echoPin, true, Port.ResistorMode.Disabled, Port.InterruptMode.InterruptEdgeBoth);
_triggerPin = new OutputPort(triggerPin, false);
_echoPin.OnInterrupt += port_OnInterrupt;
_echoPin.DisableInterrupt();
}