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

add velocity and position display

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-06-05 12:43:01 +02:00
parent 508cbfe720
commit 267e818d66
3 changed files with 19 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files

20
src/api_communication/api_communication/api_listener.py
View File

@@ -102,29 +102,13 @@ class ApiListener(Node):
self.status_data['velocity'] = msg.velocity
self.status_data['position'] = msg.position
self.status_data['failsafe'] = msg.failsafe
self.status_data['velocity'] = msg.velocity
self.status_data['position'] = msg.position
def failsafe_callback(self, msg):
self.status_data['failsafe'] = msg.enabled
self.message_queue.append(json.dumps(
{'type': ResponseMessage.FAILSAFE.name, 'message': msg.msg}))
# def send_video(self):
# self.get_logger().info('Starting video thread')
# vid = cv2.VideoCapture(0)
# # vid.set(cv2.CAP_PROP_FRAME_WIDTH, RES_4K_W)
# # vid.set(cv2.CAP_PROP_FRAME_HEIGHT, RES_4K_H)
# while True:
# try:
# while vid.isOpened():
# img,frame = vid.read()
# frame = cv2.resize(frame,(640,480))
# encode_param = [int(cv2.IMWRITE_JPEG_QUALITY), 65]
# man = cv2.imencode('.jpg', frame, encode_param)[1]
# self.get_logger().info('Sending video')
# self.message_queue.append(man.tobytes())
# except Exception as e:
# self.get_logger().error('Something went wrong while reading video: ' + str(e))
async def publish_message(self, message):
# self.get_logger().info(f'Publishing message: {message}')