diff options
Diffstat (limited to 'test/navigation/script/test-poi-guidance.py')
| -rwxr-xr-x | test/navigation/script/test-poi-guidance.py | 450 |
1 files changed, 450 insertions, 0 deletions
diff --git a/test/navigation/script/test-poi-guidance.py b/test/navigation/script/test-poi-guidance.py new file mode 100755 index 0000000..b62adf7 --- /dev/null +++ b/test/navigation/script/test-poi-guidance.py @@ -0,0 +1,450 @@ +#!/usr/bin/python + +""" +************************************************************************** +* @licence app begin@ +* SPDX-License-Identifier: MPL-2.0 +* +* \copyright Copyright (C) 2017, PSA GROUP +* +* \file test-poi-guidance.py +* +* \brief This simple test shows how the poi search +* could be easily tested using a python script +* +* \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: +* +* @licence end@ +************************************************************************** +""" + +import dbus +import gobject +import dbus.mainloop.glib +import xml.dom.minidom +import argparse +import sys +import os.path +import genivi +try: + from dltTrigger import * + dltTrigger=True + print('DLT signal sent') +except dltTriggerNotBuilt: + dltTrigger=False +#import pdb; pdb.set_trace() + +#name of the test +test_name = "poi search/route/guidance" + +#constants used into the script +TIME_OUT = 120000 +ID_FUEL = 256 +ID_HOTEL = 257 +ID_CAR_PARKING = 258 +ID_BAR = 259 +ID_RESTAURANT = 260 +ATTRIBUTE_SOURCE = 0 +ATTRIBUTE_PHONE = 2 +RADIUS_HOTEL = 100 #in tenth of meter ! +RADIUS_RESTAURANT = 500 +MAX_WINDOW_SIZE = 100 +OFFSET = 0 +NUMBER_OF_SEGMENTS = 500 +SPEED_FACTOR = 16 + +# List of coordinates +LATITUDE = list() +LONGITUDE = list() +ALTITUDE = list() +COUNTRY_STRING = list() +CITY_STRING = list() +STREET_STRING = list() +HOUSE_NUMBER_STRING = list() + +#add signal receivers +def routing_routeCalculationProgressUpdate_handler(routeHandle, status, percentage): + print ('Route Calculation: ' + str(int(percentage)) + ' %') + +def routing_routeCalculationSuccessful_handler(routeHandle,unfullfilledPreferences): + global g_guidance_active + print ('Route Calculation Successfull: ' + str(routeHandle)) + #get route overview + overview = g_routing_interface.GetRouteOverview(dbus.UInt32(g_route_handle),dbus.Array([dbus.Int32(genivi.TOTAL_DISTANCE),dbus.Int32(genivi.TOTAL_TIME)])) + #retrieve distance + totalDistance = dbus.Struct(overview[dbus.Int32(genivi.TOTAL_DISTANCE)]) + print ('Total Distance: ' + str(totalDistance[1]/1000) + ' km') + totalTime = dbus.Struct(overview[dbus.Int32(genivi.TOTAL_TIME)]) + m, s = divmod(totalTime[1], 60) + h, m = divmod(m, 60) + print ("Total Time: %d:%02d:%02d" % (h, m, s)) + #get route segments GetRouteSegments(const uint32_t& routeHandle, const int16_t& detailLevel, const std::vector< DBusCommonAPIEnumeration >& valuesToReturn, const uint32_t& numberOfSegments, const uint32_t& offset, uint32_t& totalNumberOfSegments, std::vector< std::map< DBusCommonAPIEnumeration, DBusCommonAPIVariant > >& routeSegments) + valuesToReturn = [dbus.Int32(genivi.ROAD_NAME), + dbus.Int32(genivi.START_LATITUDE), + dbus.Int32(genivi.END_LATITUDE), + dbus.Int32(genivi.START_LONGITUDE), + dbus.Int32(genivi.END_LONGITUDE), + dbus.Int32(genivi.DISTANCE), + dbus.Int32(genivi.TIME), + dbus.Int32(genivi.SPEED)] + numberOfSegments = NUMBER_OF_SEGMENTS + detailLevel = 0 + offset = 0 + ret = g_routing_interface.GetRouteSegments(dbus.UInt32(g_route_handle),dbus.Int16(detailLevel),dbus.Array(valuesToReturn),dbus.UInt32(numberOfSegments),dbus.UInt32(offset)) + print ("Total number of segments: " + str(ret[0]) ) + #len(ret[1]) is size + #ret[1][0][genivi.START_LATITUDE] is the start latitude + g_guidance_active = True +# pdb.set_trace() + launch_guidance(routeHandle) + +def session_sessionDeleted_handler(sessionHandle): + print('Session handle deleted: '+str(sessionHandle)) + if sessionHandle == g_navigationcore_session_handle: + exit(0) + else: + exit(1) + +def routing_routeDeleted_handler(routeHandle): + print('Route handle deleted: '+str(routeHandle)) + +def guidance_guidanceStatusChanged_handler(guidanceStatus,routeHandle): + global g_guidance_active + global g_total_amount_of_maneuvers + print('Guidance status changed: '+str(guidanceStatus)) + if guidanceStatus != genivi.ACTIVE and g_guidance_active == True: + g_guidance_active = False + g_routing_interface.DeleteRoute(dbus.UInt32(g_navigationcore_session_handle),dbus.UInt32(g_route_handle)) + g_navigationcore_session_interface.DeleteSession(dbus.UInt32(g_navigationcore_session_handle)) + else: + ret = g_guidance_interface.GetDestinationInformation() + m, s = divmod(ret[1], 60) + h, m = divmod(m, 60) + print ("Travel Time: %d:%02d:%02d" % (h, m, s)) + ret = g_guidance_interface.GetManeuversList(dbus.UInt16(10),dbus.UInt32(0)) + print ("Number of maneuvers: " +str(ret[1])) + print ("Next road to turn: " +ret[2][0][4]) + +def guidance_positionOnRouteChanged_handler(offsetOnRoute): + print ("Offset on route: " +str(offsetOnRoute)) + +def guidance_maneuverChanged_handler(maneuver): + if maneuver == genivi.PASSED: + print ("Maneuver passed ") + else: + print ("Maneuver: " +str(maneuver)) + ret = g_guidance_interface.GetDestinationInformation() + m, s = divmod(ret[1], 60) + h, m = divmod(m, 60) + print ("Travel Time: %d:%02d:%02d" % (h, m, s)) + ret = g_guidance_interface.GetManeuversList(dbus.UInt16(10),dbus.UInt32(0)) + print ("Number of maneuvers: " +str(ret[1])) + print ("Next road to turn: " +ret[2][0][4]) + #shortcut to end the guidance before reaching the destination + g_mapmatchedposition_interface.PauseSimulation(dbus.UInt32(g_navigationcore_session_handle)) + g_mapmatchedposition_interface.SetSimulationMode(dbus.UInt32(g_navigationcore_session_handle),dbus.Boolean(False)) + g_guidance_interface.StopGuidance(dbus.UInt32(g_navigationcore_session_handle)) + +def guidance_waypointReached_handler(isDestination): + print("Waypoint reached: " +str(isDestination)) + if isDestination == 1: + g_mapmatchedposition_interface.PauseSimulation(dbus.UInt32(g_navigationcore_session_handle)) + g_mapmatchedposition_interface.SetSimulationMode(dbus.UInt32(g_navigationcore_session_handle),dbus.Boolean(False)) + g_guidance_interface.StopGuidance(dbus.UInt32(g_navigationcore_session_handle)) + +def mapmatchedposition_simulationStatusChanged_handler(simulationStatus): + print ("Simulation status: " +str(simulationStatus)) + + +def poi_configurationChanged_signal_handler(changedSettings): + for changedSetting in changedSettings: + if changedSetting == genivi.LOCALE: + ret=g_poiConfiguration_interface.GetLocale() + print("language: " + ret[0]) + print("country: " + ret[1]) + print("script: " + ret[2]) + +def poi_poiStatus_signal_handler(poiSearchHandle,statusValue): + if poiSearchHandle == g_searchHandle: + if statusValue == genivi.SEARCH_FINISHED: + print("Search finished") + elif statusValue == genivi.SEARCH_NOT_STARTED: + g_poiSearch_interface.DeletePoiSearchHandle(poiSearchHandle) + launch_route_calculation(0) + +def poi_resultListChanged_signal_handler(poiSearchHandle,resultListSize): + global g_locations + global start + global destination + poiList=[] + if poiSearchHandle == g_searchHandle: + if resultListSize != 0: + ret=g_poiSearch_interface.RequestResultList(dbus.UInt32(poiSearchHandle),dbus.UInt16(OFFSET),dbus.UInt16(MAX_WINDOW_SIZE),[ATTRIBUTE_SOURCE,ATTRIBUTE_PHONE]) + if ret[0] == genivi.SEARCH_FINISHED and ret[1] >= 0: + print("Results: "+str(int(ret[1]))) + for result in ret[2]: + poiList.append(result[0]) + ret=g_poiSearch_interface.GetPoiDetails(poiList) + for resultDetail in ret: + if resultDetail[1][0] == ID_HOTEL: + print("Hotel: " +resultDetail[0][1]) + start=resultDetail[0][1] + g_locations["start"]=[resultDetail[0][2][0],resultDetail[0][2][1]] + elif resultDetail[1][0] == ID_RESTAURANT: + print("Restaurant: " +resultDetail[0][1]) + destination=resultDetail[0][1] + g_locations["destination"]=[resultDetail[0][2][0],resultDetail[0][2][1]] + g_poiSearch_interface.CancelPoiSearch(dbus.UInt32(poiSearchHandle)) + else: + print('No poi found') + g_poiSearch_interface.CancelPoiSearch(dbus.UInt32(poiSearchHandle)) + +def timeout(): + print ('Timeout Expired\n') + exit(1) + +def exit(value): + global g_exit + g_exit=value + if dltTrigger==True: + stopTrigger(test_name) + loop.quit() + +def launch_guidance(route): + g_guidance_interface.StartGuidance(dbus.UInt32(g_navigationcore_session_handle),dbus.UInt32(route)) + g_mapmatchedposition_interface.SetSimulationMode(dbus.UInt32(g_navigationcore_session_handle),dbus.Boolean(True)) + g_mapmatchedposition_interface.SetSimulationSpeed(dbus.UInt32(g_navigationcore_session_handle), dbus.Byte(SPEED_FACTOR)) + g_mapmatchedposition_interface.StartSimulation(dbus.UInt32(g_navigationcore_session_handle)) + +def launch_route_calculation(route): + global g_current_route + global g_route_handle + global g_routing_interface + global g_navigationcore_session_handle + global g_locations + global start + global destination + g_current_route = route + #get route handle + ret = g_routing_interface.CreateRoute(dbus.UInt32(g_navigationcore_session_handle)) + g_route_handle=ret[1] + print ('Route handle: ' + str(g_route_handle)) + print ('Calculating route from \ + '+start+'(' + str(g_locations["start"][0]) + ',' + str(g_locations["start"][1]) + ') to \ + '+destination+'(' + str(g_locations["destination"][0]) + ',' + str(g_locations["destination"][1]) + ')' ) + #set waypoints + waypointDoubleCapiType = 0x03 + g_routing_interface.SetWaypoints(dbus.UInt32(g_navigationcore_session_handle), \ + dbus.UInt32(g_route_handle), \ + dbus.Boolean(0), \ + dbus.Array([ \ + dbus.Dictionary({dbus.Int32(genivi.LATITUDE):dbus.Struct([dbus.Byte(waypointDoubleCapiType),dbus.Double(g_locations["start"][0])]),dbus.Int32(genivi.LONGITUDE):dbus.Struct([dbus.Byte(waypointDoubleCapiType),dbus.Double(g_locations["start"][1])])}), \ + dbus.Dictionary({dbus.Int32(genivi.LATITUDE):dbus.Struct([dbus.Byte(waypointDoubleCapiType),dbus.Double(g_locations["destination"][0])]),dbus.Int32(genivi.LONGITUDE):dbus.Struct([dbus.Byte(waypointDoubleCapiType),dbus.Double(g_locations["destination"][1])])}) \ + ]) \ + ) + + #calculate route + g_routing_interface.CalculateRoute(dbus.UInt32(g_navigationcore_session_handle),dbus.UInt32(g_route_handle)) + +print('\n--------------------------') +print('Poi Test') +print('--------------------------\n') + +#this script loads a file that could contains several locations but only uses the first one (to avoid creating specific resource) +g_exit=0 + +parser = argparse.ArgumentParser(description='Poi Test for navigation PoC and FSA.') +parser.add_argument('-l','--loc',action='store', dest='locations', help='List of locations in xml format') +parser.add_argument("-v", "--verbose", action='store_true',help='print the whole log messages') +parser.add_argument('-s','--string',action='store', dest='string', help='String to search') +args = parser.parse_args() + +if args.string == None: + print('string to search is missing, by default no string, get all') + stringToSearch='' +else: + stringToSearch=args.string + +if args.locations == None: + print('location file is missing') + print >>sys.stderr,'Test '+test_name+' FAILED' + sys.exit(1) +else: + if not os.path.isfile(args.locations): + print('file not exists') + print >>sys.stderr,'Test '+test_name+' FAILED' + sys.exit(1) + try: + DOMTree = xml.dom.minidom.parse(args.locations) + except OSError as e: + print >>sys.stderr,'Test '+test_name+' FAILED' + sys.exit(1) + location_set = DOMTree.documentElement + +print("Area : %s" % location_set.getAttribute("area")) + +locations = location_set.getElementsByTagName("location") + +for location in location_set.getElementsByTagName("location"): + LATITUDE.append(location.getElementsByTagName("latitude")[0].childNodes[0].data) + LONGITUDE.append(location.getElementsByTagName("longitude")[0].childNodes[0].data) + ALTITUDE.append(0) + COUNTRY_STRING.append(location.getElementsByTagName("country")[0].childNodes[0].data) + CITY_STRING.append(location.getElementsByTagName("city")[0].childNodes[0].data) + STREET_STRING.append(location.getElementsByTagName("street")[0].childNodes[0].data) + HOUSE_NUMBER_STRING.append(location.getElementsByTagName("number")[0].childNodes[0].data) + +if __name__ == '__main__': + dbus.mainloop.glib.DBusGMainLoop(set_as_default=True) + +print("Search for hotel and restaurant with keyword: "+ stringToSearch) + +#connect to session bus +bus = dbus.SessionBus() + +bus.add_signal_receiver(routing_routeCalculationProgressUpdate_handler, \ + dbus_interface = "org.genivi.navigation.navigationcore.Routing", \ + signal_name = "RouteCalculationProgressUpdate") + +bus.add_signal_receiver(routing_routeCalculationSuccessful_handler, \ + dbus_interface = "org.genivi.navigation.navigationcore.Routing", \ + signal_name = "RouteCalculationSuccessful") + +bus.add_signal_receiver(routing_routeDeleted_handler, \ + dbus_interface = "org.genivi.navigation.navigationcore.Routing", \ + signal_name = "RouteDeleted") + +bus.add_signal_receiver(session_sessionDeleted_handler, \ + dbus_interface = "org.genivi.navigation.navigationcore.Session", \ + signal_name = "SessionDeleted") + +bus.add_signal_receiver(guidance_guidanceStatusChanged_handler, \ + dbus_interface = "org.genivi.navigation.navigationcore.Guidance", \ + signal_name = "GuidanceStatusChanged") + +bus.add_signal_receiver(guidance_positionOnRouteChanged_handler, \ + dbus_interface = "org.genivi.navigation.navigationcore.Guidance", \ + signal_name = "PositionOnRouteChanged") + +bus.add_signal_receiver(guidance_maneuverChanged_handler, \ + dbus_interface = "org.genivi.navigation.navigationcore.Guidance", \ + signal_name = "ManeuverChanged") + +bus.add_signal_receiver(guidance_waypointReached_handler, \ + dbus_interface = "org.genivi.navigation.navigationcore.Guidance", \ + signal_name = "WaypointReached") + +bus.add_signal_receiver(mapmatchedposition_simulationStatusChanged_handler, \ + dbus_interface = "org.genivi.navigation.navigationcore.MapMatchedPosition", \ + signal_name = "SimulationStatusChanged") + +bus.add_signal_receiver(poi_configurationChanged_signal_handler, \ + dbus_interface = "org.genivi.navigation.poiservice.POIConfiguration", \ + signal_name = "ConfigurationChanged") + +bus.add_signal_receiver(poi_poiStatus_signal_handler, \ + dbus_interface = "org.genivi.navigation.poiservice.POISearch", \ + signal_name = "PoiStatus") + +bus.add_signal_receiver(poi_resultListChanged_signal_handler, \ + dbus_interface = "org.genivi.navigation.poiservice.POISearch", \ + signal_name = "ResultListChanged") + +if dltTrigger==True: + startTrigger(test_name) + +navigationcore_session_obj = bus.get_object('org.genivi.navigation.navigationcore.Session','/org/genivi/navigationcore') +g_navigationcore_session_interface = dbus.Interface(navigationcore_session_obj, dbus_interface='org.genivi.navigation.navigationcore.Session') + +routing_obj = bus.get_object('org.genivi.navigation.navigationcore.Routing','/org/genivi/navigationcore') +g_routing_interface = dbus.Interface(routing_obj, dbus_interface='org.genivi.navigation.navigationcore.Routing') + +guidance_obj = bus.get_object('org.genivi.navigation.navigationcore.Guidance','/org/genivi/navigationcore') +g_guidance_interface = dbus.Interface(guidance_obj, dbus_interface='org.genivi.navigation.navigationcore.Guidance') + +mapviewer_session_obj = bus.get_object('org.genivi.navigation.mapviewer.Session','/org/genivi/mapviewer') +g_mapviewer_session_interface = dbus.Interface(mapviewer_session_obj, dbus_interface='org.genivi.navigation.mapviewer.Session') + +mapmatchedposition_obj = bus.get_object('org.genivi.navigation.navigationcore.MapMatchedPosition','/org/genivi/navigationcore') +g_mapmatchedposition_interface = dbus.Interface(mapmatchedposition_obj, dbus_interface='org.genivi.navigation.navigationcore.MapMatchedPosition') + +poiConfiguration = bus.get_object('org.genivi.navigation.poiservice.POIConfiguration','/org/genivi/poiservice/POIConfiguration') +g_poiConfiguration_interface = dbus.Interface(poiConfiguration, dbus_interface='org.genivi.navigation.poiservice.POIConfiguration') + +poiContentAccess = bus.get_object('org.genivi.navigation.poiservice.POIContentAccess','/org/genivi/poiservice/POIContentAccess') +g_poiContentAccess_interface = dbus.Interface(poiContentAccess, dbus_interface='org.genivi.navigation.poiservice.POIContentAccess') + +poiSearch = bus.get_object('org.genivi.navigation.poiservice.POISearch','/org/genivi/poiservice/POISearch') +g_poiSearch_interface = dbus.Interface(poiSearch, dbus_interface='org.genivi.navigation.poiservice.POISearch') + +g_poiConfiguration_interface.SetLocale(dbus.String("fra"),dbus.String("FRA"),dbus.String("Latn")) + +#get navigationcore session handle +ret = g_navigationcore_session_handle = g_navigationcore_session_interface.CreateSession(dbus.String("test guidance")) +g_navigationcore_session_handle=ret[1] +print ('Navigation core session handle: ' + str(g_navigationcore_session_handle)) + +g_current_route = 0 +g_guidance_active = False +g_locations = {} +start="" +dest="" +categories=[] +ret=g_poiSearch_interface.GetAvailableCategories() +for categoryAndName in ret: + if categoryAndName[0] == ID_HOTEL or categoryAndName[0] == ID_RESTAURANT: + print("Category ID: " + str(int(categoryAndName[0]))) + categories.append(categoryAndName[0]) + print("Name: " + categoryAndName[1]) + +attributes_hotel=[] +attributes_restaurant=[] +attributesDetails=[] +ret=g_poiSearch_interface.GetCategoriesDetails(categories) +for results in ret: + if results[0][0] == ID_HOTEL: + for attribute in results[1]: + attributes_hotel.append(attribute[0]) + attributesDetails.append(dbus.Struct([dbus.UInt32(attribute[0]),dbus.UInt32(ID_HOTEL),dbus.Int32(1280),dbus.Struct([dbus.Byte(2),dbus.String("")]),dbus.Int32(1314),dbus.Boolean(False)])) + elif results[0][0] == ID_RESTAURANT: + for attribute in results[1]: + attributes_restaurant.append(attribute[0]) + attributesDetails.append(dbus.Struct([dbus.UInt32(attribute[0]),dbus.UInt32(ID_RESTAURANT),dbus.Int32(1280),dbus.Struct([dbus.Byte(2),dbus.String("")]),dbus.Int32(1314),dbus.Boolean(False)])) + +ret=g_poiSearch_interface.GetRootCategory() + +g_searchHandle=g_poiSearch_interface.CreatePoiSearchHandle() +print("Search handle: " + str(int(g_searchHandle))) + +#init the target (it's the first location in the input file by default) and test +index=0 +lat = LATITUDE[index] +lon = LONGITUDE[index] +alt = ALTITUDE[index] + +g_poiSearch_interface.SetCenter(g_searchHandle,dbus.Struct([dbus.Double(lat),dbus.Double(lon),dbus.Double(alt)])) + +g_poiSearch_interface.SetCategories(g_searchHandle,[dbus.Struct([dbus.UInt32(ID_HOTEL),dbus.UInt32(RADIUS_HOTEL)]),dbus.Struct([dbus.UInt32(ID_RESTAURANT),dbus.UInt32(RADIUS_RESTAURANT)])]) + +g_poiSearch_interface.SetAttributes(g_searchHandle,attributesDetails) + +g_poiSearch_interface.StartPoiSearch(g_searchHandle,stringToSearch,dbus.Int32(genivi.SORT_BY_DISTANCE)) + + +#main loop +gobject.timeout_add(TIME_OUT, timeout) +loop = gobject.MainLoop() +loop.run() +if g_exit == 1: + print >>sys.stderr,'Test '+test_name+' FAILED' +else: + print >>sys.stderr,'Test '+test_name+' PASSED' +sys.exit(g_exit) + |