/*
2022/04/26 07:56:11 Failed Scan Resource Not Ready
2022/04/26 07:56:11 Scanning...69
2022/04/26 07:56:11 Failed Scan Resource Not Ready
2022/04/26 07:56:11 Scanning...70
2022/04/26 07:56:11 Scanned name M_IZAR_TEST MAC DF:5F:34:32:3A:44
2022/04/26 07:56:24 Failed Connect Software caused connection abort
2022/04/26 07:56:24 Scanned name M_IZAR_TEST MAC DF:5F:41:4C:9F:92
2022/04/26 07:56:54 SUCCESS Connect (false) /org/bluez/hci0/dev_DF_5F_41_4C_9F_92
2022/04/26 07:56:55 Discovering service...
Failed to discover the Nordic UART Service: timeout on DiscoverServices
2022/04/26 07:57:05 Scanning...71
2022/04/26 07:57:09 Scanned name M_IZAR_TEST MAC DF:5F:34:32:3A:44
2022/04/26 07:57:12 Failed Connect Software caused connection abort
2022/04/26 07:57:12 Scanned name M_IZAR_TEST MAC DF:5F:34:32:3A:44
2022/04/26 07:57:12 Failed Connect Properties.GetAll org.bluez.Device1: Message recipient disconnected from message bus without replying
程序截至在这里了？？？？？
*/
package main
import (
"log"
"os"
"strings"
"time"
bluetooth "github.com/GKoSon/gobluetooth"
)
var (
serviceUUID = bluetooth.ServiceUUIDNordicUART
rxUUID = bluetooth.CharacteristicUUIDUARTRX
txUUID = bluetooth.CharacteristicUUIDUARTTX
)
var adapter = bluetooth.DefaultAdapter
var device *bluetooth.Device
const target_name = "M_IZAR_TEST"
var runCnt int64 = 0
var yesCnt int64 = 0
var failCnt int64 = 0
var rxdatacount int64 = 0
var rxdatanumber int64 = 0
func measureTime(funcName string) func() {
start := time.Now()
return func() {
log.Printf("Time taken by %s function is %v \n", funcName, time.Since(start))
}
}
func String_rm_char(a string, b string) string {
mac := ""
str := strings.Split(a, b)
for _, s := range str {
mac += s
}
return mac
}
func hciinit() bool {
if os.Args[1] == string("1") {
adapter.SetHciId("hci1")
} else if os.Args[1] == string("0") {
adapter.SetHciId("hci0")
} else {
log.Printf("please input 0 1 as hci")
return false
}
err := adapter.Enable()
if err != nil {
log.Printf("could not enable the BLE stack:%v", err.Error())
return false
}
return true
}
func oneloop() {
runCnt++
adapter.StopScan()
// Scan for NUS peripheral.
err := adapter.Scan(func(adapter *bluetooth.Adapter, result bluetooth.ScanResult) {
//defer measureTime("SCAN")()//一旦开启 LOG很多
start := time.Now()
if !result.AdvertisementPayload.HasServiceUUID(serviceUUID) {
return
}
/*加强停止Scan函数的限制条件*/
/*额外 条件1--从机必须有名字 而且符合约定*/
//log.Printf("Scanned MAC %s", result.Address.String())
if target_name != result.AdvertisementPayload.LocalName() {
//log.Printf("Failed name he is %s",result.AdvertisementPayload.LocalName())
return
}
log.Printf("Scanned name %s MAC %s", result.LocalName(), result.Address.String())
log.Printf("ScanedTarget %s", String_rm_char(result.Address.String(), ":"))
/*额外 条件2--从机连接成功*/
d, e := adapter.Connect(result.Address, bluetooth.ConnectionParams{})
if e != nil {
log.Printf("FailedConnect %v", e)
failCnt++
return
}
log.Printf("ConnectedTarget (%v) %s [%v]", d.IsConnected(), d.DevPath,time.Since(start))
device = d
// Stop the scan.真正的退出scan这个杜塞函数
err := adapter.StopScan()
if err != nil {
// Unlikely, but we can't recover from this.
log.Printf("Failed StopScan %v ", err.Error())
}
})
if err != nil {
log.Printf("Failed Scan %v ", err.Error())
log.Printf("===========END=========(%d)\r\n", failCnt)
failCnt = 0
return
}
// Connected. Look up the Nordic UART Service.
log.Printf("Discovering service...")
services, err := device.DiscoverServices([]bluetooth.UUID{serviceUUID})
if err != nil {
println("Failed to discover the Nordic UART Service:", err.Error())
log.Printf("===========END=========(%d)\r\n", failCnt)
failCnt = 0
return
}
service := services[0]
// Get the two characteristics present in this service.
chars, err := service.DiscoverCharacteristics([]bluetooth.UUID{rxUUID, txUUID})
if err != nil {
println("Failed to discover RX and TX characteristics:", err.Error())
log.Printf("===========END=========(%d)\r\n", failCnt)
failCnt = 0
return
}
var rx bluetooth.DeviceCharacteristic
var tx bluetooth.DeviceCharacteristic
if chars[0].UUID() == txUUID {
tx = chars[0]
rx = chars[1]
} else {
tx = chars[1]
rx = chars[0]
}
log.Printf("RX %v\r\n", rx)
//log.Printf("TX %v\r\n", tx)
//log.Printf("DiscoverCharacteristics:%+v\r\n", chars)
//Enable notifications to receive incoming data.
err = tx.EnableNotifications(func(value []byte) {
//log.Printf("PI recv %d bytes: %X\r\n", len(value), value)
log.Printf("PI recv %d \r\n", len(value))
rxdatacount++
rxdatanumber = rxdatanumber + int64(len(value))
})
if err != nil {
log.Printf("Failed EnableNotifications %+v\r\n", err.Error())
log.Printf("===========END=========(%d)\r\n", failCnt)
failCnt = 0
return
}
log.Printf("Connected.When NODE disconnect.This pid while Exit\r\n")
/*等待从机断开 PI从不发消息*/
for {
if !device.IsConnected() {
yesCnt++
log.Printf("TotalCount=%d,yes=%d,fail=%d,rxdatacount=%d,rxdatanumber=%d", runCnt, yesCnt, failCnt, rxdatacount, rxdatanumber)
log.Printf("===========END=========device GoodBye\r\n")
rxdatacount = 0
rxdatanumber = 0
return
}
time.Sleep(time.Microsecond * 200)
}
}
func loginit() {
logFile, logErr := os.OpenFile("pi_hci.log", os.O_CREATE|os.O_RDWR|os.O_APPEND, 0666)
if logErr != nil {
os.Exit(1)
}
log.Printf("log will write a file")
log.SetOutput(logFile)
log.SetFlags(log.Ldate | log.Ltime | log.Lshortfile)
log.Printf("Server abort! Cause:%v \n", "test log file")
}
func main() {
//loginit()
if !hciinit() {
return
}
for {
oneloop()
}
}
|
