|
5 | 5 |
|
6 | 6 | from rtde import RTDE as _RTDE |
7 | 7 | from rtde.rtde_config import ConfigFile |
| 8 | +from ctypes import c_uint32 |
8 | 9 |
|
9 | | -UINT32 = NewType("UINT32", int) |
| 10 | +u32 = NewType("u32", c_uint32) |
10 | 11 |
|
11 | 12 |
|
12 | 13 | class RTDE: |
@@ -73,25 +74,27 @@ def robot_status(self) -> dict[str, bool]: |
73 | 74 | - **`Bit 10`**: Is stopped due to safety |
74 | 75 | """ |
75 | 76 | data = self._get_data() |
76 | | - rsb: UINT32 = data.robot_status_bits |
77 | | - ssb: UINT32 = data.safety_status_bits |
| 77 | + rsb: u32 = data.robot_status_bits |
| 78 | + ssb: u32 = data.safety_status_bits |
| 79 | + |
| 80 | + bit = lambda data, n: bool(data & (1 << n)) |
78 | 81 |
|
79 | 82 | return { |
80 | 83 | # Robot status bits |
81 | | - "Power On": bool(rsb & 1), |
82 | | - "Program Running": bool(rsb & 2), |
83 | | - "Teach Button": bool(rsb & 4), |
84 | | - "Power Button": bool(rsb & 8), |
| 84 | + "Power On": bit(rsb, 0), |
| 85 | + "Program Running": bit(rsb, 1), |
| 86 | + "Teach Button": bit(rsb, 2), |
| 87 | + "Power Button": bit(rsb, 3), |
85 | 88 | # Safety status bits |
86 | | - "Normal Mode": bool(ssb & 1), |
87 | | - "Reduced Mode": bool(ssb & 2), |
88 | | - "Protective Stop": bool(ssb & 4), |
89 | | - "Recovery Mode": bool(ssb & 8), |
90 | | - "Safeguard Stopped": bool(ssb & 16), |
91 | | - "System Emergency Stopped": bool(ssb & 32), |
92 | | - "Robot Emergency Stopped": bool(ssb & 64), |
93 | | - "Emergency Stopped": bool(ssb & 128), |
94 | | - "Violation": bool(ssb & 256), |
95 | | - "Fault": bool(ssb & 512), |
96 | | - "Stopped Due to Safety": bool(ssb & 1024), |
| 89 | + "Normal Mode": bit(ssb, 0), |
| 90 | + "Reduced Mode": bit(ssb, 1), |
| 91 | + "Protective Stop": bit(ssb, 2), |
| 92 | + "Recovery Mode": bit(ssb, 3), |
| 93 | + "Safeguard Stopped": bit(ssb, 4), |
| 94 | + "System Emergency Stopped": bit(ssb, 5), |
| 95 | + "Robot Emergency Stopped": bit(ssb, 6), |
| 96 | + "Emergency Stopped": bit(ssb, 7), |
| 97 | + "Violation": bit(ssb, 8), |
| 98 | + "Fault": bit(ssb, 9), |
| 99 | + "Stopped Due to Safety": bit(ssb, 10), |
97 | 100 | } |
0 commit comments