1 files changed, 118 insertions, 0 deletions
diff --git a/test/navigation/intensive-testing.py b/test/navigation/intensive-testing.py
new file mode 100644
index 0000000..dde955e
--- /dev/null
+++ b/test/navigation/intensive-testing.py
@@ -0,0 +1,118 @@
+#!/usr/bin/python
+
+"""
+**************************************************************************
+* @licence app begin@
+* SPDX-License-Identifier: MPL-2.0
+*
+* \copyright Copyright (C) 2014, PCA Peugeot Citroen
+*
+* \file intensive-testing.py
+*
+* \brief This script tests the enhanced position by using  the logreplayer at a given frame rate.
+*
+* \author Philippe Colliot <philippe.colliot@mpsa.com>
+*
+* \version 1.0
+*
+* This Source Code Form is subject to the terms of the
+* Mozilla Public License, v. 2.0. If a copy of the MPL was not distributed with
+# this file, You can obtain one at http://mozilla.org/MPL/2.0/.
+* List of changes:
+* <date>, <name>, <description of change>
+*
+* @licence end@
+**************************************************************************
+"""
+import sys,tty,termios,select,gobject,time,dbus,re,argparse,subprocess,signal
+
+from subprocess import call 
+from subprocess import Popen 
+from threading import Timer
+from enum import Enum
+from dbus.mainloop.glib import DBusGMainLoop
+from traceback import print_exc
+
+# Define some constants
+PERIODICITY_TESTING = 200 #in ms
+DURATION_TESTING = 20000 #in ms
+MAX_LOOP_TESTING = DURATION_TESTING/PERIODICITY_TESTING
+PATH_ENHANCEDPOSITION='../../src/navigation/bin/positioning/enhanced-position-service/src/'
+PATH_LOGREPLAYER='../../src/navigation/bin/positioning/log-replayer/src/'
+PATH_LOGFILES='./'
+
+def startEnhancedPositionServer(): 
+	enhancedposition=PATH_ENHANCEDPOSITION + 'enhanced-position-service'
+	arguments='> /dev/null 2>&1 &'
+	pid = Popen([enhancedposition, arguments])
+	return pid
+
+def launchLog(file): 
+	logreplayer=PATH_LOGREPLAYER + 'log-replayer'
+	file=PATH_LOGFILES + file
+	arguments='> /dev/null 2>&1 &'
+	call([logreplayer, file, arguments])
+
+class Genivi(Enum):
+	ENHANCEDPOSITIONSERVICE_LATITUDE = 0x0020
+	ENHANCEDPOSITIONSERVICE_LONGITUDE = 0x0021
+	ENHANCEDPOSITIONSERVICE_ALTITUDE = 0x0022
+      
+def loopDbus():
+	global testCounter
+	# launch the logreplayer with test file
+	launchLog("test.log")
+	# get the geolocation
+	geoLocation = enhancedPositionInterface.GetData(dbus.Array([Genivi.ENHANCEDPOSITIONSERVICE_LATITUDE,Genivi.ENHANCEDPOSITIONSERVICE_LONGITUDE]))
+	latitude=float(geoLocation[dbus.UInt16(Genivi.ENHANCEDPOSITIONSERVICE_LATITUDE)])
+	longitude=float(geoLocation[dbus.UInt16(Genivi.ENHANCEDPOSITIONSERVICE_LONGITUDE)])
+	testCounter += 1
+	print str(testCounter), str(latitude), str(longitude)
+	if testCounter >= MAX_LOOP_TESTING:
+		cleanExit()
+	return True 
+
+def cleanExit():
+	global enhancedpositionPid
+	enhancedpositionPid.kill()
+	sys.exit(1)
+	
+def exitProg(signum, frame):
+	# restore the original signal handler and exit 
+	signal.signal(signal.SIGINT, original_sigint)
+	cleanExit()
+
+# Main program begins here
+parser = argparse.ArgumentParser(description='Intensive testing of enhanced position.')
+
+# Start the enhanced position server
+enhancedpositionPid = startEnhancedPositionServer()
+time.sleep(.5)
+ 
+# Initialize DBus loop as the main loop
+DBusGMainLoop(set_as_default=True)
+
+# Connect on the bus
+dbus.mainloop.glib.DBusGMainLoop(set_as_default=True)
+dbusConnectionBus = dbus.SessionBus()
+
+# Enhanced position
+try:
+	enhancedPositionObject = dbusConnectionBus.get_object("org.genivi.positioning.EnhancedPosition", "/org/genivi/positioning/EnhancedPosition")
+except dbus.DBusException:
+	print "connection to Enhanced position failed"
+	print_exc()
+	cleanExit()
+
+enhancedPositionInterface = dbus.Interface(enhancedPositionObject, "org.genivi.positioning.EnhancedPosition")
+
+# Start
+testCounter=0
+original_sigint = signal.getsignal(signal.SIGINT)
+signal.signal(signal.SIGINT, exitProg)
+gobject.timeout_add(PERIODICITY_TESTING,loopDbus)
+loop = gobject.MainLoop()
+loop.run()
+
+
+