DBTServer01.java

Go to the documentation of this file.

/**
 * Author: Sven Gothel <sgothel@jausoft.com>
 * Copyright (c) 2022 Gothel Software e.K.
 *
 * Permission is hereby granted, free of charge, to any person obtaining
 * a copy of this software and associated documentation files (the
 * "Software"), to deal in the Software without restriction, including
 * without limitation the rights to use, copy, modify, merge, publish,
 * distribute, sublicense, and/or sell copies of the Software, and to
 * permit persons to whom the Software is furnished to do so, subject to
 * the following conditions:
 *
 * The above copyright notice and this permission notice shall be
 * included in all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
 * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
 * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 */
 
package trial.org.direct_bt;
 
import java.nio.charset.StandardCharsets;
import java.util.ArrayList;
import java.util.Arrays;
import java.util.concurrent.atomic.AtomicInteger;
 
import org.direct_bt.AdapterSettings;
import org.direct_bt.AdapterStatusListener;
import org.direct_bt.BTMode;
import org.direct_bt.BTSecurityLevel;
import org.direct_bt.BTAdapter;
import org.direct_bt.BTDevice;
import org.direct_bt.BTSecurityRegistry;
import org.direct_bt.BTUtils;
import org.direct_bt.DBGattChar;
import org.direct_bt.DBGattDesc;
import org.direct_bt.DBGattServer;
import org.direct_bt.DBGattService;
import org.direct_bt.DBGattValue;
import org.direct_bt.DiscoveryPolicy;
import org.direct_bt.EIRDataTypeSet;
import org.direct_bt.EInfoReport;
import org.direct_bt.GAPFlags;
import org.direct_bt.GattCharPropertySet;
import org.direct_bt.HCIStatusCode;
import org.direct_bt.LE_Features;
import org.direct_bt.LE_PHYs;
import org.direct_bt.PairingMode;
import org.direct_bt.SMPIOCapability;
import org.direct_bt.SMPPairingState;
import org.direct_bt.ScanType;
import org.jau.io.PrintUtil;
import org.jau.net.EUI48;
import org.jau.sys.Clock;
import org.jau.util.BasicTypes;
import org.junit.Assert;
 
/**
 * This peripheral BTRole::Slave test participant works with DBTClient00.
 */
public class DBTServer01 implements DBTServerTest {
    final boolean GATT_VERBOSE = false;
    private final String adapterShortName = "TDev1Srv";
 
    private final boolean SHOW_UPDATE_EVENTS = false;
 
    private String adapterName = "TestDev1_Srv";
    private EUI48 useAdapter = EUI48.ALL_DEVICE;
    private BTMode btMode = BTMode.DUAL;
    private boolean use_SC = true;
    private BTSecurityLevel adapterSecurityLevel = BTSecurityLevel.UNSET;
    private final MyAdapterStatusListener myAdapterStatusListener = new MyAdapterStatusListener();
    private final MyGATTServerListener gattServerListener = new MyGATTServerListener();
    private BTAdapter serverAdapter = null;
    private final Object sync_lock = new Object();
    private volatile BTDevice connectedDevice;
 
    private final AtomicInteger disconnectCount = new AtomicInteger(0);
    private final AtomicInteger servedProtocolSessionsTotal = new AtomicInteger(0);
    private final AtomicInteger servedProtocolSessionsSuccess = new AtomicInteger(0);
    private final AtomicInteger servingProtocolSessionsLeft = new AtomicInteger(1);
 
    private final boolean do_disconnect_randomly;
 
    public DBTServer01(final String adapterName, final EUI48 useAdapter, final BTMode btMode, final boolean use_SC, final BTSecurityLevel adapterSecurityLevel, final boolean do_disconnect_randomly) {
        this.adapterName = adapterName;
        this.useAdapter = useAdapter;
        this.btMode = btMode;
        this.use_SC = use_SC;
        this.adapterSecurityLevel = adapterSecurityLevel;
        this.do_disconnect_randomly = do_disconnect_randomly;
 
        dbGattServer.addListener( gattServerListener );
    }
    public DBTServer01(final String adapterName, final EUI48 useAdapter, final BTMode btMode, final boolean use_SC, final BTSecurityLevel adapterSecurityLevel) {
        this(adapterName, useAdapter, btMode, use_SC, adapterSecurityLevel, false /* do_disconnect_randomly */);
    }
 
    @Override
    public String getName() { return adapterName; }
 
    @Override
    public BTSecurityLevel getSecurityLevel() { return adapterSecurityLevel; }
 
    @Override
    public void setAdapter(final BTAdapter serverAdapter) {
        this.serverAdapter = serverAdapter;
    }
    @Override
    public BTAdapter getAdapter() { return serverAdapter; }
 
    @Override
    public void setProtocolSessionsLeft(final int v) {
        servingProtocolSessionsLeft.set(v);
    }
    @Override
    public int getProtocolSessionsLeft() {
        return servingProtocolSessionsLeft.get();
    }
    @Override
    public int getProtocolSessionsDoneTotal() {
        return servedProtocolSessionsTotal.get();
    }
    @Override
    public int getProtocolSessionsDoneSuccess() {
        return servedProtocolSessionsSuccess.get();
    }
 
    @Override
    public int getDisconnectCount() {
        return this.disconnectCount.get();
    }
 
    private final void setDevice(final BTDevice cd) {
        synchronized( sync_lock ) {
            connectedDevice = cd;
        }
    }
 
    private final BTDevice getDevice() {
        synchronized( sync_lock ) {
            return connectedDevice;
        }
    }
 
    private boolean matches(final BTDevice device) {
        final BTDevice d = getDevice();
        return null != d ? d.equals(device) : false;
    }
 
    static Thread executeOffThread(final Runnable runobj, final String threadName, final boolean detach) {
        final Thread t = new Thread( runobj, threadName );
        t.setDaemon( detach );
        t.start();
        return t;
    }
    static Thread executeOffThread(final Runnable runobj, final boolean detach) {
        final Thread t = new Thread( runobj );
        t.setDaemon( detach );
        t.start();
        return t;
    }
 
    // DBGattServerRef dbGattServer = std::make_shared<DBGattServer>(
    private final DBGattServer dbGattServer = new DBGattServer(
            /* services: */
            Arrays.asList( // DBGattService
              new DBGattService ( true /* primary */,
                  DBGattService.UUID16.GENERIC_ACCESS /* type_ */,
                  Arrays.asList( // DBGattChar
                      new DBGattChar( DBGattChar.UUID16.DEVICE_NAME /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Read),
                                  new ArrayList<DBGattDesc>(/* intentionally w/o Desc */ ),
                                  DBGattValue.make(adapterName, 128) /* value */ ),
                      new DBGattChar( DBGattChar.UUID16.APPEARANCE /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Read),
                                  new ArrayList<DBGattDesc>(/* intentionally w/o Desc */ ),
                                  DBGattValue.make((short)0) /* value */ )
                  ) ),
              new DBGattService ( true /* primary */,
                  DBGattService.UUID16.DEVICE_INFORMATION /* type_ */,
                  Arrays.asList( // DBGattChar
                      new DBGattChar( DBGattChar.UUID16.MANUFACTURER_NAME_STRING /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Read),
                                  new ArrayList<DBGattDesc>(/* intentionally w/o Desc */ ),
                                  DBGattValue.make("Gothel Software") /* value */ ),
                      new DBGattChar( DBGattChar.UUID16.MODEL_NUMBER_STRING /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Read),
                                  new ArrayList<DBGattDesc>(/* intentionally w/o Desc */ ),
                                  DBGattValue.make("3.2.0-pre") /* value */ ),
                      new DBGattChar( DBGattChar.UUID16.SERIAL_NUMBER_STRING /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Read),
                                  new ArrayList<DBGattDesc>(/* intentionally w/o Desc */ ),
                                  DBGattValue.make("sn:0123456789") /* value */ ),
                      new DBGattChar( DBGattChar.UUID16.HARDWARE_REVISION_STRING /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Read),
                                  new ArrayList<DBGattDesc>(/* intentionally w/o Desc */ ),
                                  DBGattValue.make("hw:0123456789") /* value */ ),
                      new DBGattChar( DBGattChar.UUID16.FIRMWARE_REVISION_STRING /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Read),
                                  new ArrayList<DBGattDesc>(/* intentionally w/o Desc */ ),
                                  DBGattValue.make("fw:0123456789") /* value */ ),
                      new DBGattChar( DBGattChar.UUID16.SOFTWARE_REVISION_STRING /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Read),
                                  new ArrayList<DBGattDesc>(/* intentionally w/o Desc */ ),
                                  DBGattValue.make("sw:0123456789") /* value */ )
                  ) ),
              new DBGattService ( true /* primary */,
                  DBTConstants.DataServiceUUID /* type_ */,
                  Arrays.asList( // DBGattChar
                      new DBGattChar( DBTConstants.StaticDataUUID /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Read),
                                  Arrays.asList( // DBGattDesc
                                      new DBGattDesc( DBGattDesc.UUID16.USER_DESC, DBGattValue.make("DATA_STATIC") )
                                  ),
                                DBGattValue.make("Proprietary Static Data 0x00010203") /* value */ ),
                      new DBGattChar( DBTConstants.CommandUUID /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.WriteNoAck).set(GattCharPropertySet.Type.WriteWithAck),
                                  Arrays.asList( // DBGattDesc
                                      new DBGattDesc( DBGattDesc.UUID16.USER_DESC, DBGattValue.make("COMMAND") )
                                  ),
                                  DBGattValue.make(128, 64) /* value */ ),
                      new DBGattChar( DBTConstants.ResponseUUID /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Notify).set(GattCharPropertySet.Type.Indicate),
                                  Arrays.asList( // DBGattDesc
                                      new DBGattDesc( DBGattDesc.UUID16.USER_DESC, DBGattValue.make("RESPONSE") ),
                                      DBGattDesc.createClientCharConfig()
                                  ),
                                  DBGattValue.make((short)0) /* value */ ),
                      new DBGattChar( DBTConstants.PulseDataUUID /* value_type_ */,
                                  new GattCharPropertySet(GattCharPropertySet.Type.Notify).set(GattCharPropertySet.Type.Indicate),
                                  Arrays.asList( // DBGattDesc
                                      new DBGattDesc( DBGattDesc.UUID16.USER_DESC, DBGattValue.make("DATA_PULSE") ),
                                      DBGattDesc.createClientCharConfig()
                                  ),
                                  DBGattValue.make("Synthethic Sensor 01") /* value */ )
                  ) )
            ) );
 
 
    class MyAdapterStatusListener extends AdapterStatusListener {
        @Override
        public void adapterSettingsChanged(final BTAdapter adapter, final AdapterSettings oldmask,
                                           final AdapterSettings newmask, final AdapterSettings changedmask, final long timestamp) {
            final boolean initialSetting = oldmask.isEmpty();
            if( initialSetting ) {
                PrintUtil.println(System.err, "****** Server SETTINGS_INITIAL: "+oldmask+" -> "+newmask+", changed "+changedmask);
            } else {
                PrintUtil.println(System.err, "****** Server SETTINGS_CHANGED: "+oldmask+" -> "+newmask+", changed "+changedmask);
 
                final boolean justPoweredOn = changedmask.isSet(AdapterSettings.SettingType.POWERED) &&
                                              newmask.isSet(AdapterSettings.SettingType.POWERED);
                if( justPoweredOn && serverAdapter.equals(adapter) ) {
                    executeOffThread( () -> { startAdvertising("powered_on"); },
                                  "Server DBT-StartAdvertising-"+adapter.getAddressAndType(), true /* detach */);
                }
            }
            PrintUtil.println(System.err, "Server Status Adapter:");
            PrintUtil.println(System.err, adapter.toString());
        }
 
        @Override
        public void discoveringChanged(final BTAdapter adapter, final ScanType currentMeta, final ScanType changedType, final boolean changedEnabled, final DiscoveryPolicy policy, final long timestamp) {
            PrintUtil.println(System.err, "****** Server DISCOVERING: meta "+currentMeta+", changed["+changedType+", enabled "+changedEnabled+", policy "+policy+"] on "+adapter);
        }
 
        @Override
        public boolean deviceFound(final BTDevice device, final long timestamp) {
            PrintUtil.println(System.err, "****** Server FOUND__-1: NOP "+device.toString());
            return false;
        }
 
        @Override
        public void deviceUpdated(final BTDevice device, final EIRDataTypeSet updateMask, final long timestamp) {
            if( SHOW_UPDATE_EVENTS ) {
                PrintUtil.println(System.err, "****** Server UPDATED: "+updateMask+" of "+device);
            }
        }
 
        @Override
        public void deviceConnected(final BTDevice device, final boolean discovered, final long timestamp) {
            PrintUtil.println(System.err, "****** Server CONNECTED (served "+disconnectCount.get()+", left "+servingProtocolSessionsLeft.get()+"): discovered "+discovered+": "+device+" on "+device.getAdapter());
            final boolean available = null == getDevice();
            if( available ) {
                setDevice(device);
            }
        }
 
        @Override
        public void devicePairingState(final BTDevice device, final SMPPairingState state, final PairingMode mode, final long timestamp) {
            PrintUtil.println(System.err, "****** Server PAIRING_STATE: state "+state+", mode "+mode+": "+device);
            switch( state ) {
                case NONE:
                    // next: deviceReady(..)
                    break;
                case FAILED: {
                    // next: deviceReady() or deviceDisconnected(..)
                } break;
                case REQUESTED_BY_RESPONDER:
                    // next: FEATURE_EXCHANGE_STARTED
                    break;
                case FEATURE_EXCHANGE_STARTED:
                    // next: FEATURE_EXCHANGE_COMPLETED
                    break;
                case FEATURE_EXCHANGE_COMPLETED:
                    // next: PASSKEY_EXPECTED... or KEY_DISTRIBUTION
                    break;
                case PASSKEY_EXPECTED: {
                    final BTSecurityRegistry.Entry sec = BTSecurityRegistry.getStartOf(device.getAddressAndType().address, "");
                    if( null != sec && sec.getPairingPasskey() != BTSecurityRegistry.NO_PASSKEY ) {
                        executeOffThread( () -> { device.setPairingPasskey( sec.getPairingPasskey() ); }, "DBT-SetPasskey-"+device.getAddressAndType(), true /* detach */);
                    } else {
                        executeOffThread( () -> { device.setPairingPasskey( 0 ); }, "DBT-SetPasskey-"+device.getAddressAndType(), true /* detach */);
                        // 3s disconnect: executeOffThread( () -> { device.setPairingPasskeyNegative(); }, "DBT-SetPasskeyNegative-"+device.getAddressAndType(), true /* detach */);
                    }
                    // next: KEY_DISTRIBUTION or FAILED
                  } break;
                case NUMERIC_COMPARE_EXPECTED: {
                    final BTSecurityRegistry.Entry sec = BTSecurityRegistry.getStartOf(device.getAddressAndType().address, "");
                    if( null != sec ) {
                        executeOffThread( () -> { device.setPairingNumericComparison( sec.getPairingNumericComparison() ); }, "DBT-SetNumericComp-"+device.getAddressAndType(), true /* detach */);
                    } else {
                        executeOffThread( () -> { device.setPairingNumericComparison( false ); }, "DBT-SetNumericCompFalse-"+device.getAddressAndType(), true /* detach */);
                    }
                    // next: KEY_DISTRIBUTION or FAILED
                  } break;
                case OOB_EXPECTED:
                    // FIXME: ABORT
                    break;
                case KEY_DISTRIBUTION:
                    // next: COMPLETED or FAILED
                    break;
                case COMPLETED:
                    // next: deviceReady(..)
                    break;
                default: // nop
                    break;
            }
        }
 
        @Override
        public void deviceReady(final BTDevice device, final long timestamp) {
            PrintUtil.println(System.err, "****** Server READY-1: NOP " + device.toString());
        }
 
        @Override
        public void deviceDisconnected(final BTDevice device, final HCIStatusCode reason, final short handle, final long timestamp) {
            PrintUtil.println(System.err, "****** Server DISCONNECTED (served "+(1+disconnectCount.get())+", left "+servingProtocolSessionsLeft.get()+"): Reason "+reason+", old handle 0x"+Integer.toHexString(handle)+": "+device+" on "+device.getAdapter());
            final boolean match = matches(device);
            if( match ) {
                setDevice(null);
            }
            executeOffThread( () -> { processDisconnectedDevice(device); },
                              "Server DBT-Disconnected-"+device.getAdapter().getAddressAndType(), true /* detach */);
        }
 
        @Override
        public String toString() {
            return "Server AdapterStatusListener[user, per-adapter]";
        }
    };
 
    class MyGATTServerListener extends DBGattServer.Listener implements AutoCloseable {
        private final Thread pulseSenderThread;
        private volatile boolean stopPulseSenderFlag = false;
 
        private volatile short handlePulseDataNotify = 0;
        private volatile short handlePulseDataIndicate = 0;
        private volatile short handleResponseDataNotify = 0;
        private volatile short handleResponseDataIndicate = 0;
 
        private int usedMTU = 23; // BTGattHandler::number(BTGattHandler::Defaults::MIN_ATT_MTU);
 
        private void clear() {
            synchronized( sync_lock ) {
                handlePulseDataNotify = 0;
                handlePulseDataIndicate = 0;
                handleResponseDataNotify = 0;
                handleResponseDataIndicate = 0;
 
                dbGattServer.resetGattClientCharConfig(DBTConstants.DataServiceUUID, DBTConstants.PulseDataUUID);
                dbGattServer.resetGattClientCharConfig(DBTConstants.DataServiceUUID, DBTConstants.ResponseUUID);
            }
        }
 
        private boolean shallStopPulseSender() {
            synchronized( sync_lock ) {
                return stopPulseSenderFlag;
            }
        }
        private void pulseSender() {
            {
                final BTDevice connectedDevice_ = getDevice();
                final String connectedDeviceStr = null != connectedDevice_ ? connectedDevice_.toString() : "n/a";
                PrintUtil.fprintf_td(System.err, "****** Server GATT::PULSE Start %s\n", connectedDeviceStr);
            }
            while( !shallStopPulseSender() ) {
                final BTDevice connectedDevice_ = getDevice();
                if( null != connectedDevice_ && connectedDevice_.getConnected() ) {
                    if( 0 != handlePulseDataNotify || 0 != handlePulseDataIndicate ) {
                        final String data = String.format("Dynamic Data Example. Elapsed Milliseconds: %,9d", Clock.elapsedTimeMillis());
                        final byte[] v = data.getBytes(StandardCharsets.UTF_8);
                        if( 0 != handlePulseDataNotify ) {
                            if( GATT_VERBOSE ) {
                                PrintUtil.fprintf_td(System.err, "****** Server GATT::sendNotification: PULSE to %s\n", connectedDevice_.toString());
                            }
                            connectedDevice_.sendNotification(handlePulseDataNotify, v);
                        }
                        if( 0 != handlePulseDataIndicate ) {
                            if( GATT_VERBOSE ) {
                                PrintUtil.fprintf_td(System.err, "****** Server GATT::sendIndication: PULSE to %s\n", connectedDevice_.toString());
                            }
                            connectedDevice_.sendIndication(handlePulseDataIndicate, v);
                        }
                    }
                }
                if( !shallStopPulseSender() ) {
                    try {
                        Thread.sleep(100); // 100ms
                    } catch (final InterruptedException e) { }
                }
            }
            {
                final BTDevice connectedDevice_ = getDevice();
                final String connectedDeviceStr = null != connectedDevice_ ? connectedDevice_.toString() : "n/a";
                PrintUtil.fprintf_td(System.err, "****** Server GATT::PULSE End %s\n", connectedDeviceStr);
            }
        }
 
        private void sendResponse(final byte[] data) {
            final BTDevice connectedDevice_ = getDevice();
            if( null != connectedDevice_ && connectedDevice_.getConnected() ) {
                if( 0 != handleResponseDataNotify || 0 != handleResponseDataIndicate ) {
                    if( 0 != handleResponseDataNotify ) {
                        if( GATT_VERBOSE ) {
                            PrintUtil.fprintf_td(System.err, "****** Server GATT::sendNotification: %s to %s\n",
                                    BasicTypes.bytesHexString(data, 0, data.length, true /* lsb */), connectedDevice_.toString());
                        }
                        connectedDevice_.sendNotification(handleResponseDataNotify, data);
                    }
                    if( 0 != handleResponseDataIndicate ) {
                        if( GATT_VERBOSE ) {
                            PrintUtil.fprintf_td(System.err, "****** Server GATT::sendIndication: %s to %s\n",
                                    BasicTypes.bytesHexString(data, 0, data.length, true /* lsb */), connectedDevice_.toString());
                        }
                        connectedDevice_.sendIndication(handleResponseDataIndicate, data);
                    }
                }
            }
        }
 
        private void disconnectDeviceRandomly() {
            // sleep range: 100 - 1500 ms
            final int sleep_min = 100;
            final int sleep_max = 1500;
            final int sleep_dur = (int) ( Math.random() * ( sleep_max - sleep_min + 1 ) + sleep_min );
            try {
                Thread.sleep(sleep_dur); // wait a little (FIXME: Fast restart of advertising error)
            } catch (final InterruptedException e) { }
 
            final BTDevice connectedDevice_ = getDevice();
            if( null != connectedDevice_ ) {
                PrintUtil.fprintf_td(System.err, "****** Server i470 disconnectDevice(delayed %d ms): client %s\n", sleep_dur, connectedDevice_.toString());
                connectedDevice_.disconnect();
            } else {
                PrintUtil.fprintf_td(System.err, "****** Server i470 disconnectDevice(delayed %d ms): client null\n", sleep_dur);
            }
        }
 
        public MyGATTServerListener() {
            pulseSenderThread = executeOffThread( () -> { pulseSender(); }, "GattServer-PulseSender", false /* detach */);
        }
 
        @Override
        public void close() {
            synchronized( sync_lock ) {
                clear();
                stopPulseSenderFlag = true;
            }
            try {
                pulseSenderThread.join(1000);
            } catch (final InterruptedException e) { }
            super.close();
        }
 
        @Override
        public void connected(final BTDevice device, final int initialMTU) {
            final boolean match = matches(device);
            PrintUtil.fprintf_td(System.err, "****** Server GATT::connected(match %b): initMTU %d, %s\n",
                    match, initialMTU, device.toString());
            if( match ) {
                synchronized( sync_lock ) {
                    usedMTU = initialMTU;
                }
            }
        }
 
        @Override
        public void disconnected(final BTDevice device) {
            final boolean match = matches(device);
            PrintUtil.fprintf_td(System.err, "****** Server GATT::disconnected(match %b): %s\n", match, device.toString());
            if( match ) {
                clear();
            }
        }
 
        @Override
        public void mtuChanged(final BTDevice device, final int mtu) {
            final boolean match = matches(device);
            final int usedMTU_old = usedMTU;
            if( match ) {
                synchronized( sync_lock ) {
                    usedMTU = mtu;
                }
            }
            PrintUtil.fprintf_td(System.err, "****** Server GATT::mtuChanged(match %b, served %d, left %d): %d -> %d, %s\n",
                    match, servedProtocolSessionsTotal.get(), servingProtocolSessionsLeft.get(),
                    match ? usedMTU_old : 0, mtu, device.toString());
            if( do_disconnect_randomly ) {
                executeOffThread( () -> { disconnectDeviceRandomly(); }, "GattServer-DisconnectDevice", true /* detach */);
            }
        }
 
        @Override
        public boolean readCharValue(final BTDevice device, final DBGattService s, final DBGattChar c) {
            final boolean match = matches(device);
            if( GATT_VERBOSE ) {
                PrintUtil.fprintf_td(System.err, "****** Server GATT::readCharValue(match %b): to %s, from\n  %s\n    %s\n",
                        match, device.toString(), s.toString(), c.toString());
            }
            return match;
        }
 
        @Override
        public boolean readDescValue(final BTDevice device, final DBGattService s, final DBGattChar c, final DBGattDesc d) {
            final boolean match = matches(device);
            if( GATT_VERBOSE ) {
                PrintUtil.fprintf_td(System.err, "****** Server GATT::readDescValue(match %b): to %s, from\n  %s\n    %s\n      %s\n",
                        match, device.toString(), s.toString(), c.toString(), d.toString());
            }
            return match;
        }
 
        @Override
        public boolean writeCharValue(final BTDevice device, final DBGattService s, final DBGattChar c, final byte[] value, final int value_offset) {
            final boolean match = matches(device);
            if( GATT_VERBOSE ) {
                final String value_s = BasicTypes.bytesHexString(value, 0, value.length, true /* lsbFirst */)+
                                       " '"+BTUtils.decodeUTF8String(value, 0, value.length)+"'";
                PrintUtil.fprintf_td(System.err, "****** Server GATT::writeCharValue(match %b): %s @ %d from %s, to\n  %s\n    %s\n",
                        match, value_s, value_offset,
                        device.toString(), s.toString(), c.toString());
            }
            return match;
        }
 
        @Override
        public void writeCharValueDone(final BTDevice device, final DBGattService s, final DBGattChar c) {
            final boolean match = matches(device);
            final DBGattValue value = c.getValue();
            final byte[] data = value.data();
            boolean isFinalHandshake = false;
            boolean isFinalHandshakeSuccess = false;
 
            if( match &&
                c.getValueType().equals( DBTConstants.CommandUUID ) &&
                ( 0 != handleResponseDataNotify || 0 != handleResponseDataIndicate ) )
            {
                isFinalHandshakeSuccess = Arrays.equals(DBTConstants.SuccessHandshakeCommandData, data);
                isFinalHandshake = isFinalHandshakeSuccess ||
                                   Arrays.equals(DBTConstants.FailHandshakeCommandData, data);
 
                if( isFinalHandshake ) {
                    if( isFinalHandshakeSuccess ) {
                        servedProtocolSessionsSuccess.addAndGet(1);
                    }
                    servedProtocolSessionsTotal.addAndGet(1); // we assume this to be server, i.e. connected, SMP done and GATT action ..
                    if( servingProtocolSessionsLeft.get() > 0 ) {
                        servingProtocolSessionsLeft.decrementAndGet();
                    }
                }
                executeOffThread( () -> { sendResponse( data ); }, true /* detach */);
            }
            if( GATT_VERBOSE || isFinalHandshake ) {
                PrintUtil.fprintf_td(System.err, "****** Server GATT::writeCharValueDone(match %b, finalCmd %b, sessions [%d ok / %d total], left %d): From %s, to\n  %s\n    %s\n    Char-Value: %s\n",
                        match, isFinalHandshake, servedProtocolSessionsSuccess.get(), servedProtocolSessionsTotal.get(), servingProtocolSessionsLeft.get(),
                        device.toString(), s.toString(), c.toString(), value.toString());
            }
        }
 
        @Override
        public boolean writeDescValue(final BTDevice device, final DBGattService s, final DBGattChar c, final DBGattDesc d,
                                      final byte[] value, final int value_offset)
        {
            final boolean match = matches(device);
            if( GATT_VERBOSE ) {
                final String value_s = BasicTypes.bytesHexString(value, 0, value.length, true /* lsbFirst */)+
                                       " '"+BTUtils.decodeUTF8String(value, 0, value.length)+"'";
                PrintUtil.fprintf_td(System.err, "****** Server GATT::writeDescValue(match %b): %s @ %d from %s\n  %s\n    %s\n      %s\n",
                        match, value_s, value_offset,
                        device.toString(), s.toString(), c.toString(), d.toString());
            }
            return match;
        }
 
        @Override
        public void writeDescValueDone(final BTDevice device, final DBGattService s, final DBGattChar c, final DBGattDesc d) {
            if( GATT_VERBOSE ) {
                final boolean match = matches(device);
                final DBGattValue value = d.getValue();
                PrintUtil.fprintf_td(System.err, "****** Server GATT::writeDescValueDone(match %b): From %s\n  %s\n    %s\n      %s\n      Desc-Value: %s\n",
                        match, device.toString(), s.toString(), c.toString(), d.toString(), value.toString());
            }
        }
 
        @Override
        public void clientCharConfigChanged(final BTDevice device, final DBGattService s, final DBGattChar c, final DBGattDesc d,
                                            final boolean notificationEnabled, final boolean indicationEnabled)
        {
            final boolean match = matches(device);
            if( GATT_VERBOSE ) {
                final DBGattValue value = d.getValue();
                PrintUtil.fprintf_td(System.err, "****** Server GATT::clientCharConfigChanged(match %b): notify %b, indicate %b from %s\n  %s\n    %s\n      %s\n      Desc-Value: %s\n",
                        match, notificationEnabled, indicationEnabled,
                        device.toString(), s.toString(), c.toString(), d.toString(), value.toString());
            }
            if( match ) {
                final String value_type = c.getValueType();
                final short value_handle = c.getValueHandle();
                if( value_type.equals( DBTConstants.PulseDataUUID ) ) {
                    synchronized( sync_lock ) {
                        handlePulseDataNotify = notificationEnabled ? value_handle : 0;
                        handlePulseDataIndicate = indicationEnabled ? value_handle : 0;
                    }
                } else if( value_type.equals( DBTConstants.ResponseUUID ) ) {
                    synchronized( sync_lock ) {
                        handleResponseDataNotify = notificationEnabled ? value_handle : 0;
                        handleResponseDataIndicate = indicationEnabled ? value_handle : 0;
                    }
                }
            }
        }
    }
    static final short adv_interval_min=(short)160; // x0.625 = 100ms
    static final short adv_interval_max=(short)480; // x0.625 = 300ms
    static final byte adv_type=(byte)0; // AD_PDU_Type::ADV_IND;
    static final byte adv_chan_map=(byte)0x07;
    static final byte filter_policy=(byte)0x00;
 
    @Override
    public void close(final String msg) {
        PrintUtil.println(System.err, "****** Server Close.0: "+msg);
        Assert.assertTrue( serverAdapter.removeStatusListener( myAdapterStatusListener ) );
        {
            stopAdvertising(msg);
            final BTDevice connectedDevice_ = getDevice();
            if( null != connectedDevice_ ) {
                setDevice(null);
                connectedDevice_.disconnect();
            }
        }
        gattServerListener.close();
        // dbGattServer.close(); // keep alive
        stopAdvertising(msg); // try once more in case of already started AdapterStatusListener
        PrintUtil.println(System.err, "****** Server Close.X: "+msg);
    }
 
    private HCIStatusCode stopAdvertising(final String msg) {
        final HCIStatusCode status = serverAdapter.stopAdvertising();
        PrintUtil.println(System.err, "****** Server Stop advertising ("+msg+") result: "+status+": "+serverAdapter.toString());
        return status;
    }
 
    @Override
    public HCIStatusCode startAdvertising(final String msg) {
        final EInfoReport eir = new EInfoReport();
        final EIRDataTypeSet adv_mask = new EIRDataTypeSet();
        final EIRDataTypeSet scanrsp_mask = new EIRDataTypeSet();
 
        adv_mask.set(EIRDataTypeSet.DataType.FLAGS);
        adv_mask.set(EIRDataTypeSet.DataType.SERVICE_UUID);
 
        scanrsp_mask.set(EIRDataTypeSet.DataType.NAME);
        scanrsp_mask.set(EIRDataTypeSet.DataType.CONN_IVAL);
 
        eir.addFlag(GAPFlags.Bit.LE_Gen_Disc);
        eir.addFlag(GAPFlags.Bit.BREDR_UNSUP);
 
        eir.addService(DBTConstants.DataServiceUUID);
        eir.setServicesComplete(false);
 
        eir.setName(serverAdapter.getName());
        eir.setConnInterval((short)8, (short)12); // 10ms - 15ms
 
        final DBGattChar gattDevNameChar = dbGattServer.findGattChar(DBGattService.UUID16.GENERIC_ACCESS, DBGattChar.UUID16.DEVICE_NAME);
        if( null != gattDevNameChar ) {
            final byte[] aname_bytes = serverAdapter.getName().getBytes(StandardCharsets.UTF_8);
            gattDevNameChar.setValue(aname_bytes, 0, aname_bytes.length, 0);
        }
 
        PrintUtil.println(System.err, "****** Server Start advertising ("+msg+"): EIR "+eir.toString());
        PrintUtil.println(System.err, "****** Server Start advertising ("+msg+"): adv "+adv_mask.toString()+", scanrsp "+scanrsp_mask.toString());
 
        final HCIStatusCode status = serverAdapter.startAdvertising(dbGattServer, eir, adv_mask, scanrsp_mask,
                                                              adv_interval_min, adv_interval_max,
                                                              adv_type, adv_chan_map, filter_policy);
        PrintUtil.println(System.err, "****** Server Start advertising ("+msg+") result: "+status+": "+serverAdapter.toString());
        if( GATT_VERBOSE ) {
            PrintUtil.println(System.err, dbGattServer.toFullString());
        }
        return status;
    }
 
    private void processDisconnectedDevice(final BTDevice device) {
        PrintUtil.println(System.err, "****** Server Disconnected Device (count "+(1+disconnectCount.get())+
                ", served "+servedProtocolSessionsTotal.get()+", left "+servingProtocolSessionsLeft.get()+"): Start "+device.toString());
 
        // already unpaired
        stopAdvertising("device-disconnected");
        device.remove();
 
        disconnectCount.addAndGet(1);
 
        try {
            Thread.sleep(100); // wait a little (FIXME: Fast restart of advertising error)
        } catch (final InterruptedException e) { }
 
        if( servingProtocolSessionsLeft.get() > 0 ) {
            startAdvertising("device-disconnected");
        }
 
        PrintUtil.println(System.err, "****** Server Disonnected Device: End "+device.toString());
    }
 
    @Override
    public boolean initAdapter(final BTAdapter adapter) {
        if( !useAdapter.equals(EUI48.ALL_DEVICE) && !useAdapter.equals(adapter.getAddressAndType().address) ) {
            PrintUtil.fprintf_td(System.err, "initServerAdapter: Adapter not selected: %s\n", adapter.toString());
            return false;
        }
        adapterName = adapterName + "-" + adapter.getAddressAndType().address.toString().replace(":", "");
 
        if( !adapter.isInitialized() ) {
            // Initialize with defaults and power-on
            final HCIStatusCode status = adapter.initialize( btMode, false );
            if( HCIStatusCode.SUCCESS != status ) {
                PrintUtil.fprintf_td(System.err, "initServerAdapter: initialization failed: %s: %s\n",
                        status.toString(), adapter.toString());
                return false;
            }
        } else if( !adapter.setPowered( false ) ) {
            PrintUtil.fprintf_td(System.err, "initServerAdapter: setPower.1 off failed: %s\n", adapter.toString());
            return false;
        }
        // adapter is powered-off
        PrintUtil.println(System.err, "initServerAdapter.1: "+adapter.toString());
 
        {
            HCIStatusCode status = adapter.setName(adapterName, adapterShortName);
            if( HCIStatusCode.SUCCESS == status ) {
                PrintUtil.fprintf_td(System.err, "initServerAdapter: setLocalName OK: %s\n", adapter.toString());
            } else {
                PrintUtil.fprintf_td(System.err, "initServerAdapter: setLocalName failed: %s\n", adapter.toString());
                return false;
            }
 
            status = adapter.setSecureConnections( use_SC );
            if( HCIStatusCode.SUCCESS == status ) {
                PrintUtil.fprintf_td(System.err, "initServerAdapter: setSecureConnections OK: %s\n", adapter.toString());
            } else {
                PrintUtil.fprintf_td(System.err, "initServerAdapter: setSecureConnections failed: %s\n", adapter.toString());
                return false;
            }
 
            final short conn_min_interval = 8;  // 10ms
            final short conn_max_interval = 40; // 50ms
            final short conn_latency = 0;
            final short supervision_timeout = 50; // 500ms
            status = adapter.setDefaultConnParam(conn_min_interval, conn_max_interval, conn_latency, supervision_timeout);
            if( HCIStatusCode.SUCCESS == status ) {
                PrintUtil.fprintf_td(System.err, "initServerAdapter: setDefaultConnParam OK: %s\n", adapter.toString());
            } else if( HCIStatusCode.UNKNOWN_COMMAND == status ) {
                PrintUtil.fprintf_td(System.err, "initServerAdapter: setDefaultConnParam UNKNOWN_COMMAND (ignored): %s\n", adapter.toString());
            } else {
                PrintUtil.fprintf_td(System.err, "initServerAdapter: setDefaultConnParam failed: %s, %s\n", status.toString(), adapter.toString());
                return false;
            }
 
            if( !adapter.setPowered( true ) ) {
                PrintUtil.fprintf_td(System.err, "initServerAdapter: setPower.2 on failed: %s\n", adapter.toString());
                return false;
            }
        }
        // adapter is powered-on
        PrintUtil.println(System.err, "initServerAdapter.2: "+adapter.toString());
 
        {
            final LE_Features le_feats = adapter.getLEFeatures();
            PrintUtil.fprintf_td(System.err, "initServerAdapter: LE_Features %s\n", le_feats.toString());
        }
        if( adapter.getBTMajorVersion() > 4 ) {
            // BT5 specific
            final LE_PHYs Tx = new LE_PHYs( LE_PHYs.PHY.LE_2M );
            final LE_PHYs Rx = new LE_PHYs( LE_PHYs.PHY.LE_2M );
            final HCIStatusCode res = adapter.setDefaultLE_PHY(Tx, Rx);
            PrintUtil.fprintf_td(System.err, "initServerAdapter: Set Default LE PHY: status %s: Tx %s, Rx %s\n",
                                res.toString(), Tx.toString(), Rx.toString());
        }
        adapter.setSMPKeyPath(DBTConstants.SERVER_KEY_PATH);
 
        Assert.assertTrue( adapter.addStatusListener( myAdapterStatusListener ) );
 
        adapter.setServerConnSecurity(adapterSecurityLevel, SMPIOCapability.UNSET);
 
        return true;
    }
}