def callINSPVAX(self, data): inspvax_ = INSPVAX() inspvax_ = data self.calAngNS = (float(360.0 - inspvax_.azimuth))
def INS_Message(Pos, Vel, Ang, i): INS_Msg = INSPVAX() INS_Msg.header2 = Header() INS_Msg.header2.frame_id = '/INS' INS_Msg.latitude = Pos[1] INS_Msg.longitude = Pos[0] INS_Msg.altitude = Pos[2] INS_Msg.north_velocity = Vel[1] INS_Msg.east_velocity = Vel[0] INS_Msg.up_velocity = Vel[2] INS_Msg.roll = Ang[1] * INS.deg INS_Msg.pitch = Ang[0] * INS.deg INS_Msg.azimuth = Ang[2] * INS.deg time_now = time.time() secs = int(time.time()) nsecs = (time_now - secs) * 10**8 INS_Msg.header2.stamp.secs = secs INS_Msg.header2.stamp.nsecs = nsecs INS_Msg.header2.seq = i return INS_Msg
def callINSPVAXNLOS_(self, data): # 1Hz inspvax_ = INSPVAX() inspvax_ = data self.calAngNNLOS = (float(360.0 - inspvax_.azimuth))
def callINSPVAX(self,data): inspvax_ = INSPVAX() inspvax_ = data self.calAngNS = (float(360.0 - inspvax_.azimuth)) print 'self.calAngNS in puNLOSExclusionS.py',self.calAngNS