18 from math
import cos, sin
23 from std_msgs.msg
import Float64
24 from cob_msgs.msg
import EmergencyStopState, PowerState
32 self.
theta = rospy.get_param(
"~theta")
33 self.
off_y = rospy.get_param(
"~off_y")
34 self.
abcd = rospy.get_param(
"~abcd")
40 rospy.Subscriber(
"/power_board/voltage", Float64, self.
callback)
42 self.
pub_power = rospy.Publisher(
'/power_state', PowerState, queue_size=1)
47 self.
volts = data.data
50 if(self.
volts <= 44000):
52 elif(self.
volts >= 48000):
64 old_settings = np.seterr(all=
'raise')
74 self.msg_power.header.stamp = rospy.Time.now()
75 self.msg_power.time_remaining.secs = self.
t_est 82 if __name__ ==
'__main__':
83 rospy.init_node(
'volt_filt')
86 while not rospy.is_shutdown():
def process_voltage(self)