Added SoftDevice 6 support + OpenOCD flash + some fixes