public SerialBno(string comPort, int readTimeout, int writeTimeout, Bno055OpMode mode = Bno055OpMode.OperationModeAccgyro)
{
_mode = mode;
_comPort = new SerialPort(comPort, Baud, 0, 8, StopBits.One)
{
ReadTimeout = readTimeout,
WriteTimeout = writeTimeout
};
}
public SerialBNO(string comPort, int readTimeout, int writeTimeout, Bno055OpMode mode = Bno055OpMode.Operation_Mode_Accgyro) {
_mode = mode;
Debug.Print("Initialing BNO Serial Port... " + comPort + ", " + _baud + " bps");
Debug.Print("ReadTimeout: " + readTimeout);
Debug.Print("WriteTimeout: " + writeTimeout);
_comPort = new SerialPort(comPort, _baud,0,8,StopBits.One) {
ReadTimeout = readTimeout,
WriteTimeout = writeTimeout
};
}
public SerialBNO(string comPort, int readTimeout, int writeTimeout, Bno055OpMode mode = Bno055OpMode.Operation_Mode_Accgyro)
{
_mode = mode;
Debug.Print("Initialing BNO Serial Port... " + comPort + ", " + _baud + " bps");
Debug.Print("ReadTimeout: " + readTimeout);
Debug.Print("WriteTimeout: " + writeTimeout);
_comPort = new SerialPort(comPort, _baud, 0, 8, StopBits.One)
{
ReadTimeout = readTimeout,
WriteTimeout = writeTimeout
};
}
private void SetMode(Bno055OpMode mode)
{
write_byte(Bno055Registers.Bno055OprModeAddr, (byte)mode);
Thread.Sleep(20);
}
private void setMode(Bno055OpMode mode)
{
write_byte(Bno055Registers.Bno055_Opr_Mode_Addr, (byte)mode);
Thread.Sleep(20);
}
