sem/5g_drone_ROS2
1
0
Fork 0
Code Issues 1 Pull Requests 1 Actions Packages Projects Releases Wiki Activity

change response bits

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-05-17 11:40:48 +02:00
parent 19367da170
commit b3b2a9fe61
1 changed files with 3 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
src/relais_control/relais_control/relais_controller.py
View File

@@ -36,22 +36,16 @@ class RelaisController(Node):
def control_relais_callback(self, request, response): def control_relais_callback(self, request, response):
if request.relais1_on: if request.relais1_on:
GPIO.output(self.relais1_pin, GPIO.HIGH) GPIO.output(self.relais1_pin, GPIO.HIGH)
response.bits = response.bits | 1
else: else:
GPIO.output(self.relais1_pin, GPIO.LOW) GPIO.output(self.relais1_pin, GPIO.LOW)
response.bits = response.bits & ~(1 << 0)
if request.relais2_on: if request.relais2_on:
GPIO.output(self.relais2_pin, GPIO.HIGH) GPIO.output(self.relais2_pin, GPIO.HIGH)
response.bits = response.bits | (1 << 1)
else: else:
GPIO.output(self.relais2_pin, GPIO.LOW) GPIO.output(self.relais2_pin, GPIO.LOW)
if GPIO.output(17) == GPIO.LOW:
response.bits = response.bits & 0
else:
response.bits = response.bits | 1
if GPIO.output(27) == GPIO.LOW:
response.bits = response.bits & ~(1 << 1) response.bits = response.bits & ~(1 << 1)
else:
response.bits = response.bits | (1 << 1)
return response return response
def main(args=None): def main(args=None):