mirror of
https://github.com/bettercap/bettercap
synced 2025-07-30 03:29:57 -07:00
misc: small fix or general refactoring i did not bother commenting
This commit is contained in:
parent
94ade23da3
commit
44e5803a43
3 changed files with 250 additions and 232 deletions
|
@ -6,12 +6,12 @@ import (
|
||||||
)
|
)
|
||||||
|
|
||||||
var defaultBLEClientOptions = []gatt.Option{
|
var defaultBLEClientOptions = []gatt.Option{
|
||||||
gatt.LnxMaxConnections(1),
|
gatt.LnxMaxConnections(255),
|
||||||
gatt.LnxDeviceID(-1, true),
|
gatt.LnxDeviceID(-1, true),
|
||||||
}
|
}
|
||||||
|
|
||||||
var defaultBLEServerOptions = []gatt.Option{
|
var defaultBLEServerOptions = []gatt.Option{
|
||||||
gatt.LnxMaxConnections(1),
|
gatt.LnxMaxConnections(255),
|
||||||
gatt.LnxDeviceID(-1, true),
|
gatt.LnxDeviceID(-1, true),
|
||||||
gatt.LnxSetAdvertisingParameters(&cmd.LESetAdvertisingParameters{
|
gatt.LnxSetAdvertisingParameters(&cmd.LESetAdvertisingParameters{
|
||||||
AdvertisingIntervalMin: 0x00f4,
|
AdvertisingIntervalMin: 0x00f4,
|
||||||
|
|
|
@ -6,13 +6,8 @@ import (
|
||||||
"fmt"
|
"fmt"
|
||||||
"io/ioutil"
|
"io/ioutil"
|
||||||
golog "log"
|
golog "log"
|
||||||
"os"
|
|
||||||
"sort"
|
|
||||||
"strconv"
|
|
||||||
"strings"
|
|
||||||
"time"
|
"time"
|
||||||
|
|
||||||
"github.com/bettercap/bettercap/core"
|
|
||||||
"github.com/bettercap/bettercap/log"
|
"github.com/bettercap/bettercap/log"
|
||||||
"github.com/bettercap/bettercap/network"
|
"github.com/bettercap/bettercap/network"
|
||||||
"github.com/bettercap/bettercap/session"
|
"github.com/bettercap/bettercap/session"
|
||||||
|
@ -20,11 +15,6 @@ import (
|
||||||
"github.com/currantlabs/gatt"
|
"github.com/currantlabs/gatt"
|
||||||
)
|
)
|
||||||
|
|
||||||
var (
|
|
||||||
bleAliveInterval = time.Duration(5) * time.Second
|
|
||||||
blePresentInterval = time.Duration(30) * time.Second
|
|
||||||
)
|
|
||||||
|
|
||||||
type BLERecon struct {
|
type BLERecon struct {
|
||||||
session.SessionModule
|
session.SessionModule
|
||||||
gattDevice gatt.Device
|
gattDevice gatt.Device
|
||||||
|
@ -32,6 +22,7 @@ type BLERecon struct {
|
||||||
connected bool
|
connected bool
|
||||||
connTimeout time.Duration
|
connTimeout time.Duration
|
||||||
quit chan bool
|
quit chan bool
|
||||||
|
done chan bool
|
||||||
}
|
}
|
||||||
|
|
||||||
func NewBLERecon(s *session.Session) *BLERecon {
|
func NewBLERecon(s *session.Session) *BLERecon {
|
||||||
|
@ -39,6 +30,7 @@ func NewBLERecon(s *session.Session) *BLERecon {
|
||||||
SessionModule: session.NewSessionModule("ble.recon", s),
|
SessionModule: session.NewSessionModule("ble.recon", s),
|
||||||
gattDevice: nil,
|
gattDevice: nil,
|
||||||
quit: make(chan bool),
|
quit: make(chan bool),
|
||||||
|
done: make(chan bool),
|
||||||
connTimeout: time.Duration(10) * time.Second,
|
connTimeout: time.Duration(10) * time.Second,
|
||||||
currDevice: nil,
|
currDevice: nil,
|
||||||
connected: false,
|
connected: false,
|
||||||
|
@ -69,7 +61,7 @@ func NewBLERecon(s *session.Session) *BLERecon {
|
||||||
return fmt.Errorf("An enumeration for %s is already running, please wait.", d.currDevice.Device.ID())
|
return fmt.Errorf("An enumeration for %s is already running, please wait.", d.currDevice.Device.ID())
|
||||||
}
|
}
|
||||||
|
|
||||||
return d.enumAll(network.NormalizeMac(args[0]))
|
return d.enumAllTheThings(network.NormalizeMac(args[0]))
|
||||||
}))
|
}))
|
||||||
|
|
||||||
return d
|
return d
|
||||||
|
@ -93,6 +85,8 @@ func (d *BLERecon) isEnumerating() bool {
|
||||||
|
|
||||||
func (d *BLERecon) Configure() (err error) {
|
func (d *BLERecon) Configure() (err error) {
|
||||||
if d.gattDevice == nil {
|
if d.gattDevice == nil {
|
||||||
|
log.Info("Initializing BLE device ...")
|
||||||
|
|
||||||
// hey Paypal GATT library, could you please just STFU?!
|
// hey Paypal GATT library, could you please just STFU?!
|
||||||
golog.SetOutput(ioutil.Discard)
|
golog.SetOutput(ioutil.Discard)
|
||||||
if d.gattDevice, err = gatt.NewDevice(defaultBLEClientOptions...); err != nil {
|
if d.gattDevice, err = gatt.NewDevice(defaultBLEClientOptions...); err != nil {
|
||||||
|
@ -104,27 +98,13 @@ func (d *BLERecon) Configure() (err error) {
|
||||||
gatt.PeripheralConnected(d.onPeriphConnected),
|
gatt.PeripheralConnected(d.onPeriphConnected),
|
||||||
gatt.PeripheralDisconnected(d.onPeriphDisconnected),
|
gatt.PeripheralDisconnected(d.onPeriphDisconnected),
|
||||||
)
|
)
|
||||||
|
|
||||||
d.gattDevice.Init(d.onStateChanged)
|
d.gattDevice.Init(d.onStateChanged)
|
||||||
}
|
}
|
||||||
|
|
||||||
return nil
|
return nil
|
||||||
}
|
}
|
||||||
|
|
||||||
func (d *BLERecon) onStateChanged(dev gatt.Device, s gatt.State) {
|
|
||||||
switch s {
|
|
||||||
case gatt.StatePoweredOn:
|
|
||||||
log.Info("Starting BLE discovery ...")
|
|
||||||
dev.Scan([]gatt.UUID{}, true)
|
|
||||||
return
|
|
||||||
default:
|
|
||||||
log.Warning("Unexpected BLE state: %v", s)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
func (d *BLERecon) onPeriphDiscovered(p gatt.Peripheral, a *gatt.Advertisement, rssi int) {
|
|
||||||
d.Session.BLE.AddIfNew(p.ID(), p, a, rssi)
|
|
||||||
}
|
|
||||||
|
|
||||||
func (d *BLERecon) pruner() {
|
func (d *BLERecon) pruner() {
|
||||||
log.Debug("Started BLE devices pruner ...")
|
log.Debug("Started BLE devices pruner ...")
|
||||||
|
|
||||||
|
@ -147,8 +127,6 @@ func (d *BLERecon) Start() error {
|
||||||
}
|
}
|
||||||
|
|
||||||
return d.SetRunning(true, func() {
|
return d.SetRunning(true, func() {
|
||||||
log.Debug("Initializing BLE device ...")
|
|
||||||
|
|
||||||
go d.pruner()
|
go d.pruner()
|
||||||
|
|
||||||
<-d.quit
|
<-d.quit
|
||||||
|
@ -156,56 +134,44 @@ func (d *BLERecon) Start() error {
|
||||||
log.Info("Stopping BLE scan ...")
|
log.Info("Stopping BLE scan ...")
|
||||||
|
|
||||||
d.gattDevice.StopScanning()
|
d.gattDevice.StopScanning()
|
||||||
|
|
||||||
|
d.done <- true
|
||||||
})
|
})
|
||||||
}
|
}
|
||||||
|
|
||||||
func (d *BLERecon) getRow(dev *network.BLEDevice) []string {
|
func (d *BLERecon) enumAllTheThings(mac string) error {
|
||||||
address := network.NormalizeMac(dev.Device.ID())
|
dev, found := d.Session.BLE.Get(mac)
|
||||||
vendor := dev.Vendor
|
if found == false || dev == nil {
|
||||||
sinceSeen := time.Since(dev.LastSeen)
|
return fmt.Errorf("BLE device with address %s not found.", mac)
|
||||||
lastSeen := dev.LastSeen.Format("15:04:05")
|
} else if d.Running() {
|
||||||
|
d.gattDevice.StopScanning()
|
||||||
if sinceSeen <= bleAliveInterval {
|
|
||||||
lastSeen = core.Bold(lastSeen)
|
|
||||||
} else if sinceSeen > blePresentInterval {
|
|
||||||
lastSeen = core.Dim(lastSeen)
|
|
||||||
address = core.Dim(address)
|
|
||||||
}
|
}
|
||||||
|
|
||||||
isConnectable := core.Red("no")
|
d.setCurrentDevice(dev)
|
||||||
if dev.Advertisement.Connectable == true {
|
if err := d.Configure(); err != nil {
|
||||||
isConnectable = core.Green("yes")
|
return err
|
||||||
}
|
}
|
||||||
|
|
||||||
return []string{
|
log.Info("Connecting to %s ...", mac)
|
||||||
fmt.Sprintf("%d dBm", dev.RSSI),
|
|
||||||
address,
|
go func() {
|
||||||
dev.Device.Name(),
|
time.Sleep(d.connTimeout)
|
||||||
vendor,
|
if d.isEnumerating() && d.connected == false {
|
||||||
isConnectable,
|
d.Session.Events.Add("ble.connection.timeout", d.currDevice)
|
||||||
lastSeen,
|
d.onPeriphDisconnected(nil, nil)
|
||||||
}
|
}
|
||||||
|
}()
|
||||||
|
|
||||||
|
d.gattDevice.Connect(dev.Device)
|
||||||
|
|
||||||
|
return nil
|
||||||
}
|
}
|
||||||
|
|
||||||
func (d *BLERecon) Show() error {
|
func (d *BLERecon) Stop() error {
|
||||||
devices := d.Session.BLE.Devices()
|
return d.SetRunning(false, func() {
|
||||||
|
d.quit <- true
|
||||||
sort.Sort(ByBLERSSISorter(devices))
|
<-d.done
|
||||||
|
})
|
||||||
rows := make([][]string, 0)
|
|
||||||
for _, dev := range devices {
|
|
||||||
rows = append(rows, d.getRow(dev))
|
|
||||||
}
|
|
||||||
nrows := len(rows)
|
|
||||||
|
|
||||||
columns := []string{"RSSI", "Address", "Name", "Vendor", "Connectable", "Last Seen"}
|
|
||||||
|
|
||||||
if nrows > 0 {
|
|
||||||
core.AsTable(os.Stdout, columns, rows)
|
|
||||||
}
|
|
||||||
|
|
||||||
d.Session.Refresh()
|
|
||||||
return nil
|
|
||||||
}
|
}
|
||||||
|
|
||||||
func (d *BLERecon) setCurrentDevice(dev *network.BLEDevice) {
|
func (d *BLERecon) setCurrentDevice(dev *network.BLEDevice) {
|
||||||
|
@ -213,6 +179,25 @@ func (d *BLERecon) setCurrentDevice(dev *network.BLEDevice) {
|
||||||
d.currDevice = dev
|
d.currDevice = dev
|
||||||
}
|
}
|
||||||
|
|
||||||
|
func (d *BLERecon) onStateChanged(dev gatt.Device, s gatt.State) {
|
||||||
|
switch s {
|
||||||
|
case gatt.StatePoweredOn:
|
||||||
|
if d.currDevice == nil {
|
||||||
|
log.Info("Starting BLE discovery ...")
|
||||||
|
dev.Scan([]gatt.UUID{}, true)
|
||||||
|
}
|
||||||
|
case gatt.StatePoweredOff:
|
||||||
|
d.gattDevice = nil
|
||||||
|
|
||||||
|
default:
|
||||||
|
log.Warning("Unexpected BLE state: %v", s)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
func (d *BLERecon) onPeriphDiscovered(p gatt.Peripheral, a *gatt.Advertisement, rssi int) {
|
||||||
|
d.Session.BLE.AddIfNew(p.ID(), p, a, rssi)
|
||||||
|
}
|
||||||
|
|
||||||
func (d *BLERecon) onPeriphDisconnected(p gatt.Peripheral, err error) {
|
func (d *BLERecon) onPeriphDisconnected(p gatt.Peripheral, err error) {
|
||||||
if d.Running() {
|
if d.Running() {
|
||||||
// restore scanning
|
// restore scanning
|
||||||
|
@ -223,27 +208,26 @@ func (d *BLERecon) onPeriphDisconnected(p gatt.Peripheral, err error) {
|
||||||
}
|
}
|
||||||
|
|
||||||
func (d *BLERecon) onPeriphConnected(p gatt.Peripheral, err error) {
|
func (d *BLERecon) onPeriphConnected(p gatt.Peripheral, err error) {
|
||||||
defer func() {
|
|
||||||
log.Info("Disconnecting from %s ...", p.ID())
|
|
||||||
p.Device().CancelConnection(p)
|
|
||||||
}()
|
|
||||||
|
|
||||||
// timed out
|
// timed out
|
||||||
if d.currDevice == nil {
|
if d.currDevice == nil {
|
||||||
log.Debug("Connected to %s but after the timeout :(", p.ID())
|
log.Warning("Connected to %s but after the timeout :(", p.ID())
|
||||||
return
|
return
|
||||||
}
|
}
|
||||||
|
|
||||||
d.connected = true
|
d.connected = true
|
||||||
|
|
||||||
|
defer func(per gatt.Peripheral) {
|
||||||
|
log.Info("Disconnecting from %s ...", per.ID())
|
||||||
|
per.Device().CancelConnection(per)
|
||||||
|
}(p)
|
||||||
|
|
||||||
d.Session.Events.Add("ble.device.connected", d.currDevice)
|
d.Session.Events.Add("ble.device.connected", d.currDevice)
|
||||||
|
|
||||||
/*
|
if err := p.SetMTU(500); err != nil {
|
||||||
if err := p.SetMTU(500); err != nil {
|
log.Warning("Failed to set MTU: %s", err)
|
||||||
log.Warning("Failed to set MTU: %s", err)
|
}
|
||||||
} */
|
|
||||||
|
|
||||||
log.Info("Enumerating all the things for %s!", p.ID())
|
log.Info("Connected, enumerating all the things for %s!", p.ID())
|
||||||
services, err := p.DiscoverServices(nil)
|
services, err := p.DiscoverServices(nil)
|
||||||
if err != nil {
|
if err != nil {
|
||||||
log.Error("Error discovering services: %s", err)
|
log.Error("Error discovering services: %s", err)
|
||||||
|
@ -252,153 +236,3 @@ func (d *BLERecon) onPeriphConnected(p gatt.Peripheral, err error) {
|
||||||
|
|
||||||
d.showServices(p, services)
|
d.showServices(p, services)
|
||||||
}
|
}
|
||||||
|
|
||||||
func parseProperties(ch *gatt.Characteristic) (props []string, isReadable bool) {
|
|
||||||
isReadable = false
|
|
||||||
props = make([]string, 0)
|
|
||||||
mask := ch.Properties()
|
|
||||||
|
|
||||||
if (mask & gatt.CharBroadcast) != 0 {
|
|
||||||
props = append(props, "bcast")
|
|
||||||
}
|
|
||||||
if (mask & gatt.CharRead) != 0 {
|
|
||||||
isReadable = true
|
|
||||||
props = append(props, "read")
|
|
||||||
}
|
|
||||||
if (mask&gatt.CharWriteNR) != 0 || (mask&gatt.CharWrite) != 0 {
|
|
||||||
props = append(props, core.Bold("write"))
|
|
||||||
}
|
|
||||||
if (mask & gatt.CharNotify) != 0 {
|
|
||||||
props = append(props, "notify")
|
|
||||||
}
|
|
||||||
if (mask & gatt.CharIndicate) != 0 {
|
|
||||||
props = append(props, "indicate")
|
|
||||||
}
|
|
||||||
if (mask & gatt.CharSignedWrite) != 0 {
|
|
||||||
props = append(props, core.Yellow("*write"))
|
|
||||||
}
|
|
||||||
if (mask & gatt.CharExtended) != 0 {
|
|
||||||
props = append(props, "x")
|
|
||||||
}
|
|
||||||
|
|
||||||
return
|
|
||||||
}
|
|
||||||
|
|
||||||
func parseRawData(raw []byte) string {
|
|
||||||
s := ""
|
|
||||||
for _, b := range raw {
|
|
||||||
if b != 00 && strconv.IsPrint(rune(b)) == false {
|
|
||||||
return fmt.Sprintf("%x", raw)
|
|
||||||
} else if b == 0 {
|
|
||||||
break
|
|
||||||
} else {
|
|
||||||
s += fmt.Sprintf("%c", b)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return core.Yellow(s)
|
|
||||||
}
|
|
||||||
|
|
||||||
func (d *BLERecon) showServices(p gatt.Peripheral, services []*gatt.Service) {
|
|
||||||
columns := []string{"Handles", "Service > Characteristics", "Properties", "Data"}
|
|
||||||
rows := make([][]string, 0)
|
|
||||||
|
|
||||||
for _, svc := range services {
|
|
||||||
d.Session.Events.Add("ble.device.service.discovered", svc)
|
|
||||||
|
|
||||||
name := svc.Name()
|
|
||||||
if name == "" {
|
|
||||||
name = svc.UUID().String()
|
|
||||||
} else {
|
|
||||||
name = fmt.Sprintf("%s (%s)", core.Green(name), core.Dim(svc.UUID().String()))
|
|
||||||
}
|
|
||||||
|
|
||||||
row := []string{
|
|
||||||
fmt.Sprintf("%04x -> %04x", svc.Handle(), svc.EndHandle()),
|
|
||||||
name,
|
|
||||||
"",
|
|
||||||
"",
|
|
||||||
}
|
|
||||||
|
|
||||||
rows = append(rows, row)
|
|
||||||
|
|
||||||
chars, err := p.DiscoverCharacteristics(nil, svc)
|
|
||||||
if err != nil {
|
|
||||||
log.Error("Error while enumerating chars for service %s: %s", svc.UUID(), err)
|
|
||||||
continue
|
|
||||||
}
|
|
||||||
|
|
||||||
for _, ch := range chars {
|
|
||||||
d.Session.Events.Add("ble.device.characteristic.discovered", ch)
|
|
||||||
|
|
||||||
name = ch.Name()
|
|
||||||
if name == "" {
|
|
||||||
name = " " + ch.UUID().String()
|
|
||||||
} else {
|
|
||||||
name = fmt.Sprintf(" %s (%s)", core.Green(name), core.Dim(ch.UUID().String()))
|
|
||||||
}
|
|
||||||
|
|
||||||
props, isReadable := parseProperties(ch)
|
|
||||||
|
|
||||||
data := ""
|
|
||||||
if isReadable {
|
|
||||||
raw, err := p.ReadCharacteristic(ch)
|
|
||||||
if err != nil {
|
|
||||||
data = core.Red(err.Error())
|
|
||||||
} else {
|
|
||||||
data = parseRawData(raw)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
row := []string{
|
|
||||||
fmt.Sprintf("%04x", ch.Handle()),
|
|
||||||
name,
|
|
||||||
strings.Join(props, ", "),
|
|
||||||
data,
|
|
||||||
}
|
|
||||||
|
|
||||||
rows = append(rows, row)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
core.AsTable(os.Stdout, columns, rows)
|
|
||||||
d.Session.Refresh()
|
|
||||||
}
|
|
||||||
|
|
||||||
func (d *BLERecon) enumAll(mac string) error {
|
|
||||||
dev, found := d.Session.BLE.Get(mac)
|
|
||||||
if found == false {
|
|
||||||
return fmt.Errorf("BLE device with address %s not found.", mac)
|
|
||||||
}
|
|
||||||
|
|
||||||
services := dev.Device.Services()
|
|
||||||
if len(services) > 0 {
|
|
||||||
d.showServices(dev.Device, services)
|
|
||||||
} else {
|
|
||||||
d.setCurrentDevice(dev)
|
|
||||||
|
|
||||||
log.Info("Connecting to %s ...", mac)
|
|
||||||
|
|
||||||
if d.Running() {
|
|
||||||
d.gattDevice.StopScanning()
|
|
||||||
}
|
|
||||||
|
|
||||||
go func() {
|
|
||||||
time.Sleep(d.connTimeout)
|
|
||||||
if d.currDevice != nil && d.connected == false {
|
|
||||||
d.Session.Events.Add("ble.connection.timeout", d.currDevice)
|
|
||||||
d.onPeriphDisconnected(nil, nil)
|
|
||||||
}
|
|
||||||
}()
|
|
||||||
|
|
||||||
d.gattDevice.Connect(dev.Device)
|
|
||||||
}
|
|
||||||
|
|
||||||
return nil
|
|
||||||
}
|
|
||||||
|
|
||||||
func (d *BLERecon) Stop() error {
|
|
||||||
return d.SetRunning(false, func() {
|
|
||||||
d.quit <- true
|
|
||||||
})
|
|
||||||
}
|
|
||||||
|
|
184
modules/ble_recon_view.go
Normal file
184
modules/ble_recon_view.go
Normal file
|
@ -0,0 +1,184 @@
|
||||||
|
// +build !windows
|
||||||
|
|
||||||
|
package modules
|
||||||
|
|
||||||
|
import (
|
||||||
|
"fmt"
|
||||||
|
"os"
|
||||||
|
"sort"
|
||||||
|
"strconv"
|
||||||
|
"strings"
|
||||||
|
"time"
|
||||||
|
|
||||||
|
"github.com/bettercap/bettercap/core"
|
||||||
|
"github.com/bettercap/bettercap/log"
|
||||||
|
"github.com/bettercap/bettercap/network"
|
||||||
|
|
||||||
|
"github.com/currantlabs/gatt"
|
||||||
|
)
|
||||||
|
|
||||||
|
var (
|
||||||
|
bleAliveInterval = time.Duration(5) * time.Second
|
||||||
|
blePresentInterval = time.Duration(30) * time.Second
|
||||||
|
)
|
||||||
|
|
||||||
|
func (d *BLERecon) getRow(dev *network.BLEDevice) []string {
|
||||||
|
address := network.NormalizeMac(dev.Device.ID())
|
||||||
|
vendor := dev.Vendor
|
||||||
|
sinceSeen := time.Since(dev.LastSeen)
|
||||||
|
lastSeen := dev.LastSeen.Format("15:04:05")
|
||||||
|
|
||||||
|
if sinceSeen <= bleAliveInterval {
|
||||||
|
lastSeen = core.Bold(lastSeen)
|
||||||
|
} else if sinceSeen > blePresentInterval {
|
||||||
|
lastSeen = core.Dim(lastSeen)
|
||||||
|
address = core.Dim(address)
|
||||||
|
}
|
||||||
|
|
||||||
|
isConnectable := core.Red("no")
|
||||||
|
if dev.Advertisement.Connectable == true {
|
||||||
|
isConnectable = core.Green("yes")
|
||||||
|
}
|
||||||
|
|
||||||
|
return []string{
|
||||||
|
fmt.Sprintf("%d dBm", dev.RSSI),
|
||||||
|
address,
|
||||||
|
dev.Device.Name(),
|
||||||
|
vendor,
|
||||||
|
isConnectable,
|
||||||
|
lastSeen,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
func (d *BLERecon) Show() error {
|
||||||
|
devices := d.Session.BLE.Devices()
|
||||||
|
|
||||||
|
sort.Sort(ByBLERSSISorter(devices))
|
||||||
|
|
||||||
|
rows := make([][]string, 0)
|
||||||
|
for _, dev := range devices {
|
||||||
|
rows = append(rows, d.getRow(dev))
|
||||||
|
}
|
||||||
|
nrows := len(rows)
|
||||||
|
|
||||||
|
columns := []string{"RSSI", "Address", "Name", "Vendor", "Connectable", "Last Seen"}
|
||||||
|
|
||||||
|
if nrows > 0 {
|
||||||
|
core.AsTable(os.Stdout, columns, rows)
|
||||||
|
}
|
||||||
|
|
||||||
|
d.Session.Refresh()
|
||||||
|
return nil
|
||||||
|
}
|
||||||
|
|
||||||
|
func parseProperties(ch *gatt.Characteristic) (props []string, isReadable bool) {
|
||||||
|
isReadable = false
|
||||||
|
props = make([]string, 0)
|
||||||
|
mask := ch.Properties()
|
||||||
|
|
||||||
|
if (mask & gatt.CharBroadcast) != 0 {
|
||||||
|
props = append(props, "bcast")
|
||||||
|
}
|
||||||
|
if (mask & gatt.CharRead) != 0 {
|
||||||
|
isReadable = true
|
||||||
|
props = append(props, "read")
|
||||||
|
}
|
||||||
|
if (mask&gatt.CharWriteNR) != 0 || (mask&gatt.CharWrite) != 0 {
|
||||||
|
props = append(props, core.Bold("write"))
|
||||||
|
}
|
||||||
|
if (mask & gatt.CharNotify) != 0 {
|
||||||
|
props = append(props, "notify")
|
||||||
|
}
|
||||||
|
if (mask & gatt.CharIndicate) != 0 {
|
||||||
|
props = append(props, "indicate")
|
||||||
|
}
|
||||||
|
if (mask & gatt.CharSignedWrite) != 0 {
|
||||||
|
props = append(props, core.Yellow("*write"))
|
||||||
|
}
|
||||||
|
if (mask & gatt.CharExtended) != 0 {
|
||||||
|
props = append(props, "x")
|
||||||
|
}
|
||||||
|
|
||||||
|
return
|
||||||
|
}
|
||||||
|
|
||||||
|
func parseRawData(raw []byte) string {
|
||||||
|
s := ""
|
||||||
|
for _, b := range raw {
|
||||||
|
if b != 00 && strconv.IsPrint(rune(b)) == false {
|
||||||
|
return fmt.Sprintf("%x", raw)
|
||||||
|
} else if b == 0 {
|
||||||
|
break
|
||||||
|
} else {
|
||||||
|
s += fmt.Sprintf("%c", b)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return core.Yellow(s)
|
||||||
|
}
|
||||||
|
|
||||||
|
func (d *BLERecon) showServices(p gatt.Peripheral, services []*gatt.Service) {
|
||||||
|
columns := []string{"Handles", "Service > Characteristics", "Properties", "Data"}
|
||||||
|
rows := make([][]string, 0)
|
||||||
|
|
||||||
|
for _, svc := range services {
|
||||||
|
d.Session.Events.Add("ble.device.service.discovered", svc)
|
||||||
|
|
||||||
|
name := svc.Name()
|
||||||
|
if name == "" {
|
||||||
|
name = svc.UUID().String()
|
||||||
|
} else {
|
||||||
|
name = fmt.Sprintf("%s (%s)", core.Green(name), core.Dim(svc.UUID().String()))
|
||||||
|
}
|
||||||
|
|
||||||
|
row := []string{
|
||||||
|
fmt.Sprintf("%04x -> %04x", svc.Handle(), svc.EndHandle()),
|
||||||
|
name,
|
||||||
|
"",
|
||||||
|
"",
|
||||||
|
}
|
||||||
|
|
||||||
|
rows = append(rows, row)
|
||||||
|
|
||||||
|
chars, err := p.DiscoverCharacteristics(nil, svc)
|
||||||
|
if err != nil {
|
||||||
|
log.Error("Error while enumerating chars for service %s: %s", svc.UUID(), err)
|
||||||
|
continue
|
||||||
|
}
|
||||||
|
|
||||||
|
for _, ch := range chars {
|
||||||
|
d.Session.Events.Add("ble.device.characteristic.discovered", ch)
|
||||||
|
|
||||||
|
name = ch.Name()
|
||||||
|
if name == "" {
|
||||||
|
name = " " + ch.UUID().String()
|
||||||
|
} else {
|
||||||
|
name = fmt.Sprintf(" %s (%s)", core.Green(name), core.Dim(ch.UUID().String()))
|
||||||
|
}
|
||||||
|
|
||||||
|
props, isReadable := parseProperties(ch)
|
||||||
|
|
||||||
|
data := ""
|
||||||
|
if isReadable {
|
||||||
|
raw, err := p.ReadCharacteristic(ch)
|
||||||
|
if err != nil {
|
||||||
|
data = core.Red(err.Error())
|
||||||
|
} else {
|
||||||
|
data = parseRawData(raw)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
row := []string{
|
||||||
|
fmt.Sprintf("%04x", ch.Handle()),
|
||||||
|
name,
|
||||||
|
strings.Join(props, ", "),
|
||||||
|
data,
|
||||||
|
}
|
||||||
|
|
||||||
|
rows = append(rows, row)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
core.AsTable(os.Stdout, columns, rows)
|
||||||
|
d.Session.Refresh()
|
||||||
|
}
|
Loading…
Add table
Add a link
Reference in a new issue