small amount of cleanup for some missed changes

This commit is contained in:
Ken Steinfeldt
2018-03-08 16:03:31 -08:00
parent 3eac5910d2
commit 10750a7a5f
3 changed files with 113 additions and 18 deletions

View File

@@ -0,0 +1,94 @@
#!/usr/bin/env python
import rospy
from rover_status.msg import *
from PyQt5 import QtWidgets, QtCore, QtGui, uic
class SensorCore(QtCore.QThread):
def __init__(self, screen):
super(SensorCore, self).__init__()
self.not_abort = True
self.screen_main_window = screen
self.cpu_read = self.screen_main_window.lineEdit # type: QtWidgets.QLabel
self.ram_read = self.screen_main_window.lineEdit_2 # type: QtWidgets.QLabel
rospy.init_node('SensorCore')
# self.pub = rospy.Publisher('rover_statuses_chatter', RoverSysStatus, queue_size=10)
# Subscription examples on pulling data from system_statuses_node.py
rospy.Subscriber('camera_system_status_chatter', CameraStatuses, self.__camera_callback)
rospy.Subscriber('bogie_system_status_chatter', BogieStatuses, self.__bogie_callback)
rospy.Subscriber('FrSky_system_status_chatter', FrSkyStatus, self.__frsky_callback)
rospy.Subscriber('GPS_system_status_chatter', GPSInfo, self.__gps_callback)
rospy.Subscriber('jetson_system_status_chatter', JetsonInfo, self.__jetson_callback)
rospy.Subscriber('misc_system_status_chatter', MiscStatuses, self.__misc_callback)
self.camera_msg = CameraStatuses()
self.bogie_msg = BogieStatuses()
self.FrSky_msg = FrSkyStatus()
self.GPS_msg = GPSInfo()
self.jetson_msg = JetsonInfo()
self.misc_msg = MiscStatuses()
def __camera_callback(self, data):
self.camera_msg.camera_zed = data.camera_zed
self.camera_msg.camera_undercarriage = data.camera_undercarriage
self.camera_msg.camera_chassis = data.camera_chassis
self.camera_msg.camera_main_navigation = data.camera_main_navigation
def __frsky_callback(self, data):
self.FrSky_msg.FrSky_controller_connection_status = data.FrSky_controller_connection_status
def __bogie_callback(self, data):
self.bogie_msg.bogie_connection_1 = data.bogie_connection_1
self.bogie_msg.bogie_connection_2 = data.bogie_connection_2
self.bogie_msg.bogie_connection_3 = data.bogie_connection_3
def __jetson_callback(self, data):
self.jetson_msg.jetson_CPU = data.jetson_CPU
self.cpu_read.setText(str(self.jetson_msg.jetson_CPU))
self.jetson_msg.jetson_RAM = data.jetson_RAM
self.ram_read.setText(str(self.jetson_msg.jetson_RAM))
self.jetson_msg.jetson_EMMC = data.jetson_EMMC
self.jetson_msg.jetson_NVME_SSD = data.jetson_NVME_SSD
#rospy.loginfo(self.jetson_msg)
def __gps_callback(self, data):
self.GPS_msg.UTC_GPS_time = data.UTC_GPS_time
self.GPS_msg.GPS_connection_status = data.GPS_connection_status
def __misc_callback(self, data):
self.misc_msg.arm_connection_status = data.arm_connection_status
self.misc_msg.arm_end_effector_connection_statuses = data.arm_end_effector_connection_statuses
self.misc_msg.sample_containment_connection_status = data.sample_containment_connection_status
self.misc_msg.tower_connection_status = data.tower_connection_status
self.misc_msg.chassis_pan_tilt_connection_status = data.chassis_pan_tilt_connection_status
def run(self):
rospy.Subscriber('camera_system_status_chatter', CameraStatuses, self.__camera_callback)
rospy.Subscriber('bogie_system_status_chatter', BogieStatuses, self.__bogie_callback)
rospy.Subscriber('FrSky_system_status_chatter', FrSkyStatus, self.__frsky_callback)
rospy.Subscriber('GPS_system_status_chatter', GPSInfo, self.__gps_callback)
rospy.Subscriber('jetson_system_status_chatter', JetsonInfo, self.__jetson_callback)
rospy.Subscriber('misc_system_status_chatter', MiscStatuses, self.__misc_callback)
#self.gui_element = self.jetson_msg.jetson_CPU
#print(self.jetson_msg.jetson_CPU)
rospy.spin()
def on_kill_threads_requested__slot(self):
self.not_abort = False
def connect_signals_and_slots(self):
pass
if __name__ == '__main__':
rover_statuses = SensorCore()
rover_statuses.run()

View File

@@ -1,19 +1,20 @@
int8 UTC_GPS_time int8 UTC_GPS_time
int8 bogie_connection_1 bool bogie_connection_1
int8 bogie_connection_2 bool bogie_connection_2
int8 bogie_connection_3 bool bogie_connection_3
int8 arm_connection_status bool arm_connection_status
int8 arm_end_effector_connection_statuses bool arm_end_effector_connection_statuses
int8 camera_zed bool camera_zed
int8 camera_undercarriage bool camera_undercarriage
int8 camera_chassis bool camera_chassis
int8 camera_main_navigation bool camera_main_navigation
int8 sample_containment_connection_status bool sample_containment_connection_status
int8 tower_connection_status bool tower_connection_status
int8 chassis_pan_tilt_connection_status bool chassis_pan_tilt_connection_status
int8 GPS_connection_status int8 GPS_connection_status
int8 jetson_CPU float64 jetson_CPU
int8 jetson_RAM float64 jetson_RAM
int8 jetson_EMMC float64 jetson_EMMC
int8 jetson_NVME_SSD float64 jetson_NVME_SSD
int8 FrSky_controller_connection_status float64 jetson_GPU_temp
bool FrSky_controller_connection_status

View File

@@ -158,7 +158,7 @@ class SystemStatuses:
.replace("\n", "").replace("+", "").split() .replace("\n", "").replace("+", "").split()
self.jetson_msg.jetson_GPU_temp = float(parsed_temps[4]) self.jetson_msg.jetson_GPU_temp = float(parsed_temps[4])
except subprocess.CalledProcessError: except subprocess.CalledProcessError:
print 'sensors call failed (potential reason: on VM)' print('sensors call failed (potential reason: on VM)')
self.jetson_msg.jetson_GPU_temp = -1.0 self.jetson_msg.jetson_GPU_temp = -1.0
# EMMC and NVMe_SSD used % calculation # EMMC and NVMe_SSD used % calculation