forked from angelodlfrtr/go-canopen
-
Notifications
You must be signed in to change notification settings - Fork 2
/
Copy pathpdo_maps.go
57 lines (45 loc) · 1.05 KB
/
pdo_maps.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
package canopen
// PDOMaps define a PDO map
type PDOMaps struct {
PDONode *PDONode
Maps map[int]*PDOMap
}
// NewPDOMaps create a new Maps
func NewPDOMaps(comOffset, mapOffset int, pdoNode *PDONode) *PDOMaps {
pdoMaps := &PDOMaps{
PDONode: pdoNode,
Maps: make(map[int]*PDOMap),
}
for i := 0; i < 32; i++ {
if comSdo := pdoMaps.PDONode.Node.ObjectDic.FindIndex(uint16(comOffset + i)); comSdo != nil {
mapSdo := pdoMaps.PDONode.Node.ObjectDic.FindIndex(uint16(mapOffset + i))
comSdo.SetSDO(pdoMaps.PDONode.Node.SDOClient)
mapSdo.SetSDO(pdoMaps.PDONode.Node.SDOClient)
pdoMaps.Maps[i+1] = NewPDOMap(pdoNode, comSdo, mapSdo)
}
}
return pdoMaps
}
// FindIndex a map by index
func (maps *PDOMaps) FindIndex(idx int) *PDOMap {
if m, ok := maps.Maps[idx]; ok {
return m
}
return nil
}
// FindName a map
func (maps *PDOMaps) FindName(name string) *PDOMap {
var m *PDOMap
for _, ma := range maps.Maps {
for _, v := range ma.Map {
if v.GetName() == name {
m = ma
break
}
}
if m != nil {
break
}
}
return m
}