misc: small fix or general refactoring i did not bother commenting

This commit is contained in:
evilsocket 2018-02-27 02:39:01 +01:00
parent 94ade23da3
commit 44e5803a43
3 changed files with 250 additions and 232 deletions

View file

@ -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,

View file

@ -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
View 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()
}