mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-07-15 22:32:11 +08:00
FrogAi
21 lines
814 B
Python
21 lines
814 B
Python
from cereal import messaging
|
|
|
|
|
|
LOCATION1 = (32.7174, -117.16277)
|
|
LOCATION2 = (32.7558, -117.2037)
|
|
|
|
LLK_DECIMATION = 10
|
|
RENDER_FRAMES = 15
|
|
DEFAULT_ITERATIONS = RENDER_FRAMES * LLK_DECIMATION
|
|
|
|
|
|
def generate_liveLocationKalman(location=LOCATION1):
|
|
msg = messaging.new_message('liveLocationKalman')
|
|
msg.liveLocationKalman.positionGeodetic = {'value': [*location, 0], 'std': [0., 0., 0.], 'valid': True}
|
|
msg.liveLocationKalman.positionECEF = {'value': [0., 0., 0.], 'std': [0., 0., 0.], 'valid': True}
|
|
msg.liveLocationKalman.calibratedOrientationNED = {'value': [0., 0., 0.], 'std': [0., 0., 0.], 'valid': True}
|
|
msg.liveLocationKalman.velocityCalibrated = {'value': [0., 0., 0.], 'std': [0., 0., 0.], 'valid': True}
|
|
msg.liveLocationKalman.status = 'valid'
|
|
msg.liveLocationKalman.gpsOK = True
|
|
return msg
|