new: parsing BLE flags and company identifiers from advertisements

modules/ble/ble_show_services.go

@@ -0,0 +1,154 @@
+// +build !windows
+// +build !darwin
+
+package ble
+
+import (
+	"fmt"
+	"os"
+	"strconv"
+	"strings"
+
+	"github.com/bettercap/gatt"
+
+	"github.com/evilsocket/islazy/tui"
+)
+
+func parseProperties(ch *gatt.Characteristic) (props []string, isReadable bool, isWritable bool, withResponse bool) {
+	isReadable = false
+	isWritable = false
+	withResponse = 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, tui.Bold("write"))
+		isWritable = true
+		withResponse = (mask & gatt.CharWriteNR) == 0
+	}
+	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, tui.Yellow("*write"))
+		isWritable = true
+		withResponse = true
+	}
+	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)) {
+			return fmt.Sprintf("%x", raw)
+		} else if b == 0 {
+			break
+		} else {
+			s += fmt.Sprintf("%c", b)
+		}
+	}
+
+	return tui.Yellow(s)
+}
+
+func (mod *BLERecon) showServices(p gatt.Peripheral, services []*gatt.Service) {
+	columns := []string{"Handles", "Service > Characteristics", "Properties", "Data"}
+	rows := make([][]string, 0)
+
+	wantsToWrite := mod.writeUUID != nil
+	foundToWrite := false
+
+	for _, svc := range services {
+		mod.Session.Events.Add("ble.device.service.discovered", svc)
+
+		name := svc.Name()
+		if name == "" {
+			name = svc.UUID().String()
+		} else {
+			name = fmt.Sprintf("%s (%s)", tui.Green(name), tui.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 {
+			mod.Error("error while enumerating chars for service %s: %s", svc.UUID(), err)
+			continue
+		}
+
+		for _, ch := range chars {
+			mod.Session.Events.Add("ble.device.characteristic.discovered", ch)
+
+			name = ch.Name()
+			if name == "" {
+				name = "    " + ch.UUID().String()
+			} else {
+				name = fmt.Sprintf("    %s (%s)", tui.Green(name), tui.Dim(ch.UUID().String()))
+			}
+
+			props, isReadable, isWritable, withResponse := parseProperties(ch)
+
+			if wantsToWrite && mod.writeUUID.Equal(ch.UUID()) {
+				foundToWrite = true
+				if isWritable {
+					mod.Info("writing %d bytes to characteristics %s ...", len(mod.writeData), mod.writeUUID)
+				} else {
+					mod.Warning("attempt to write %d bytes to non writable characteristics %s ...", len(mod.writeData), mod.writeUUID)
+				}
+
+				err := p.WriteCharacteristic(ch, mod.writeData, !withResponse)
+				if err != nil {
+					mod.Error("error while writing: %s", err)
+				}
+			}
+
+			data := ""
+			if isReadable {
+				raw, err := p.ReadCharacteristic(ch)
+				if err != nil {
+					data = tui.Red(err.Error())
+				} else {
+					data = parseRawData(raw)
+				}
+			}
+
+			row := []string{
+				fmt.Sprintf("%04x", ch.Handle()),
+				name,
+				strings.Join(props, ", "),
+				data,
+			}
+
+			rows = append(rows, row)
+		}
+	}
+
+	if wantsToWrite && !foundToWrite {
+		mod.Error("writable characteristics %s not found.", mod.writeUUID)
+	} else {
+		tui.Table(os.Stdout, columns, rows)
+		mod.Session.Refresh()
+	}
+}