new: implemented ble.enum and refactored how tabular views work ( ref #74 )

This commit is contained in:
evilsocket 2018-02-27 00:35:42 +01:00
parent b8e48e7f8a
commit ec58c55370
9 changed files with 341 additions and 52 deletions

View file

@ -8,6 +8,7 @@ import (
golog "log"
"os"
"sort"
"strconv"
"strings"
"time"
@ -16,9 +17,7 @@ import (
"github.com/bettercap/bettercap/network"
"github.com/bettercap/bettercap/session"
"github.com/bettercap/gatt"
"github.com/olekukonko/tablewriter"
"github.com/currantlabs/gatt"
)
var (
@ -28,8 +27,11 @@ var (
type BLERecon struct {
session.SessionModule
gattDevice gatt.Device
quit chan bool
gattDevice gatt.Device
currDevice *network.BLEDevice
connected bool
connTimeout time.Duration
quit chan bool
}
func NewBLERecon(s *session.Session) *BLERecon {
@ -37,6 +39,9 @@ func NewBLERecon(s *session.Session) *BLERecon {
SessionModule: session.NewSessionModule("ble.recon", s),
gattDevice: nil,
quit: make(chan bool),
connTimeout: time.Duration(10) * time.Second,
currDevice: nil,
connected: false,
}
d.AddHandler(session.NewModuleHandler("ble.recon on", "",
@ -57,6 +62,16 @@ func NewBLERecon(s *session.Session) *BLERecon {
return d.Show()
}))
d.AddHandler(session.NewModuleHandler("ble.enum MAC", "ble.enum ([a-fA-F0-9]{1,2}:[a-fA-F0-9]{1,2}:[a-fA-F0-9]{1,2}:[a-fA-F0-9]{1,2}:[a-fA-F0-9]{1,2}:[a-fA-F0-9]{1,2})",
"Enumerate services and characteristics for the given BLE device.",
func(args []string) error {
if d.isEnumerating() == true {
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
}
@ -72,6 +87,10 @@ func (d BLERecon) Author() string {
return "Simone Margaritelli <evilsocket@protonmail.com>"
}
func (d *BLERecon) isEnumerating() bool {
return d.currDevice != nil
}
func (d *BLERecon) Configure() (err error) {
if d.gattDevice == nil {
// hey Paypal GATT library, could you please just STFU?!
@ -80,7 +99,11 @@ func (d *BLERecon) Configure() (err error) {
return err
}
d.gattDevice.Handle(gatt.PeripheralDiscovered(d.onPeriphDiscovered))
d.gattDevice.Handle(
gatt.PeripheralDiscovered(d.onPeriphDiscovered),
gatt.PeripheralConnected(d.onPeriphConnected),
gatt.PeripheralDisconnected(d.onPeriphDisconnected),
)
d.gattDevice.Init(d.onStateChanged)
}
@ -149,9 +172,9 @@ func (d *BLERecon) getRow(dev *network.BLEDevice) []string {
address = core.Dim(address)
}
isConnectable := core.Red("")
isConnectable := core.Red("no")
if dev.Advertisement.Connectable == true {
isConnectable = core.Green("")
isConnectable = core.Green("yes")
}
return []string{
@ -159,21 +182,11 @@ func (d *BLERecon) getRow(dev *network.BLEDevice) []string {
address,
dev.Device.Name(),
vendor,
strings.Join(dev.Advertisement.Flags, ", "),
isConnectable,
lastSeen,
}
}
func (d *BLERecon) showTable(header []string, rows [][]string) {
fmt.Println()
table := tablewriter.NewWriter(os.Stdout)
table.SetHeader(header)
table.SetColWidth(80)
table.AppendBulk(rows)
table.Render()
}
func (d *BLERecon) Show() error {
devices := d.Session.BLE.Devices()
@ -185,16 +198,205 @@ func (d *BLERecon) Show() error {
}
nrows := len(rows)
columns := []string{"RSSI", "Address", "Name", "Vendor", "Flags", "Connectable", "Last Seen"}
columns := []string{"RSSI", "Address", "Name", "Vendor", "Connectable", "Last Seen"}
if nrows > 0 {
d.showTable(columns, rows)
core.AsTable(os.Stdout, columns, rows)
}
d.Session.Refresh()
return nil
}
func (d *BLERecon) setCurrentDevice(dev *network.BLEDevice) {
d.connected = false
d.currDevice = dev
}
func (d *BLERecon) onPeriphDisconnected(p gatt.Peripheral, err error) {
if d.Running() {
// restore scanning
log.Info("Device disconnected, restoring BLE discovery.")
d.setCurrentDevice(nil)
d.gattDevice.Scan([]gatt.UUID{}, true)
}
}
func (d *BLERecon) onPeriphConnected(p gatt.Peripheral, err error) {
defer func() {
log.Info("Disconnecting from %s ...", p.ID())
p.Device().CancelConnection(p)
}()
// timed out
if d.currDevice == nil {
log.Debug("Connected to %s but after the timeout :(", p.ID())
return
}
d.connected = true
d.Session.Events.Add("ble.device.connected", d.currDevice)
/*
if err := p.SetMTU(500); err != nil {
log.Warning("Failed to set MTU: %s", err)
} */
log.Info("Enumerating all the things for %s!", p.ID())
services, err := p.DiscoverServices(nil)
if err != nil {
log.Error("Error discovering services: %s", err)
return
}
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