-
Notifications
You must be signed in to change notification settings - Fork 2
/
accessport.go
64 lines (47 loc) · 1.27 KB
/
accessport.go
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
// Copyright 2020 Sebastian Lehmann. All rights reserved.
// Use of this source code is governed by a GNU-style
// license that can be found in the LICENSE file.
package gostlink
import (
"errors"
"github.com/boljen/go-bitmap"
)
var (
openedAp = bitmap.New(debugAccessPortSelectionMaximum + 1)
)
func (h *StLink) usbOpenAccessPort(apsel uint16) error {
/* nothing to do on old versions */
if !h.version.flags.Get(flagHasApInit) {
return nil
}
if apsel > debugAccessPortSelectionMaximum {
return errors.New("apsel > DP_APSEL_MAX")
}
if openedAp.Get(int(apsel)) {
return nil
}
err := h.usbInitAccessPort(byte(apsel))
if err != nil {
return err
}
logger.Debugf("Access port %d enabled", apsel)
openedAp.Set(int(apsel), true)
return nil
}
func (h *StLink) usbInitAccessPort(apNum byte) error {
if !h.version.flags.Get(flagHasApInit) {
return errors.New("could not find access port command")
}
logger.Debugf("initialized access port # %d", apNum)
ctx := h.initTransfer(transferIncoming)
ctx.cmdBuf.WriteByte(cmdDebug)
ctx.cmdBuf.WriteByte(debugApiV2InitAccessPort)
ctx.cmdBuf.WriteByte(apNum)
retVal := h.usbTransferErrCheck(ctx, 2)
if retVal != nil {
logger.Error("could not init access port over usb")
return retVal
} else {
return nil
}
}