Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2017 The Android Open Source Project |
| 3 | * |
| 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
| 5 | * you may not use this file except in compliance with the License. |
| 6 | * You may obtain a copy of the License at |
| 7 | * |
| 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
| 9 | * |
| 10 | * Unless required by applicable law or agreed to in writing, software |
| 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
| 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| 13 | * See the License for the specific language governing permissions and |
| 14 | * limitations under the License. |
| 15 | */ |
| 16 | package com.android.car.hal; |
| 17 | |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 18 | import static com.android.car.CarServiceUtils.toByteArray; |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 19 | import static java.lang.Integer.toHexString; |
| 20 | |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 21 | import android.car.VehicleAreaType; |
Antonio Cortes | a6845c3 | 2017-02-06 09:22:26 -0800 | [diff] [blame] | 22 | import android.car.annotation.FutureFeature; |
Asaf Rosenfeld | 2ca6f8c | 2017-03-20 12:59:33 -0700 | [diff] [blame] | 23 | import android.car.vms.IVmsSubscriberClient; |
Antonio Cortes | 0bd67c3 | 2017-03-13 08:02:40 -0700 | [diff] [blame] | 24 | import android.car.vms.VmsLayer; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 25 | import android.car.vms.VmsLayerDependency; |
| 26 | import android.car.vms.VmsLayersOffering; |
Antonio Cortes | 2febe9f | 2017-03-24 09:42:17 -0700 | [diff] [blame] | 27 | import android.car.vms.VmsSubscriptionState; |
Pavel Maltsev | cfe9310 | 2017-02-02 12:38:08 -0800 | [diff] [blame] | 28 | import android.hardware.automotive.vehicle.V2_0.VehiclePropConfig; |
| 29 | import android.hardware.automotive.vehicle.V2_0.VehiclePropValue; |
Antonio Cortes | 747364a | 2017-02-28 10:37:24 -0800 | [diff] [blame] | 30 | import android.hardware.automotive.vehicle.V2_1.VehicleProperty; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 31 | import android.hardware.automotive.vehicle.V2_1.VmsBaseMessageIntegerValuesIndex; |
Antonio Cortes | 747364a | 2017-02-28 10:37:24 -0800 | [diff] [blame] | 32 | import android.hardware.automotive.vehicle.V2_1.VmsMessageType; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 33 | import android.hardware.automotive.vehicle.V2_1.VmsOfferingMessageIntegerValuesIndex; |
| 34 | import android.hardware.automotive.vehicle.V2_1.VmsSimpleMessageIntegerValuesIndex; |
| 35 | import android.os.Binder; |
| 36 | import android.os.IBinder; |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 37 | import android.util.Log; |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 38 | import com.android.car.CarLog; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 39 | import com.android.car.VmsLayersAvailability; |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 40 | import com.android.car.VmsPublishersInfo; |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 41 | import com.android.car.VmsRouting; |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 42 | import com.android.internal.annotations.GuardedBy; |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 43 | import java.io.PrintWriter; |
Antonio Cortes | 40b9026 | 2017-02-06 11:43:57 -0800 | [diff] [blame] | 44 | import java.util.ArrayList; |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 45 | import java.util.Collection; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 46 | import java.util.Collections; |
| 47 | import java.util.HashMap; |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 48 | import java.util.HashSet; |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 49 | import java.util.LinkedList; |
| 50 | import java.util.List; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 51 | import java.util.Map; |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 52 | import java.util.Set; |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 53 | import java.util.concurrent.CopyOnWriteArrayList; |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 54 | |
| 55 | /** |
| 56 | * This is a glue layer between the VehicleHal and the VmsService. It sends VMS properties back and |
| 57 | * forth. |
| 58 | */ |
Antonio Cortes | a6845c3 | 2017-02-06 09:22:26 -0800 | [diff] [blame] | 59 | @FutureFeature |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 60 | public class VmsHalService extends HalServiceBase { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 61 | |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 62 | private static final boolean DBG = true; |
| 63 | private static final int HAL_PROPERTY_ID = VehicleProperty.VEHICLE_MAP_SERVICE; |
| 64 | private static final String TAG = "VmsHalService"; |
| 65 | |
| 66 | private boolean mIsSupported = false; |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 67 | private CopyOnWriteArrayList<VmsHalPublisherListener> mPublisherListeners = |
| 68 | new CopyOnWriteArrayList<>(); |
| 69 | private CopyOnWriteArrayList<VmsHalSubscriberListener> mSubscriberListeners = |
| 70 | new CopyOnWriteArrayList<>(); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 71 | |
| 72 | private final IBinder mHalPublisherToken = new Binder(); |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 73 | private final VehicleHal mVehicleHal; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 74 | |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 75 | private final Object mLock = new Object(); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 76 | private final VmsRouting mRouting = new VmsRouting(); |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 77 | @GuardedBy("mLock") |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 78 | private final Map<IBinder, VmsLayersOffering> mOfferings = new HashMap<>(); |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 79 | @GuardedBy("mLock") |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 80 | private final VmsLayersAvailability mAvailableLayers = new VmsLayersAvailability(); |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 81 | private final VmsPublishersInfo mPublishersInfo = new VmsPublishersInfo(); |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 82 | |
| 83 | /** |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 84 | * The VmsPublisherService implements this interface to receive data from the HAL. |
| 85 | */ |
| 86 | public interface VmsHalPublisherListener { |
Antonio Cortes | 2febe9f | 2017-03-24 09:42:17 -0700 | [diff] [blame] | 87 | void onChange(VmsSubscriptionState subscriptionState); |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 88 | } |
| 89 | |
| 90 | /** |
| 91 | * The VmsSubscriberService implements this interface to receive data from the HAL. |
| 92 | */ |
| 93 | public interface VmsHalSubscriberListener { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 94 | // Notify listener on a data Message. |
| 95 | void onDataMessage(VmsLayer layer, byte[] payload); |
| 96 | |
| 97 | // Notify listener on a change in available layers. |
| 98 | void onLayersAvaiabilityChange(List<VmsLayer> availableLayers); |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 99 | } |
| 100 | |
| 101 | /** |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 102 | * The VmsService implements this interface to receive data from the HAL. |
| 103 | */ |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 104 | protected VmsHalService(VehicleHal vehicleHal) { |
| 105 | mVehicleHal = vehicleHal; |
| 106 | if (DBG) { |
| 107 | Log.d(TAG, "started VmsHalService!"); |
| 108 | } |
| 109 | } |
| 110 | |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 111 | public void addPublisherListener(VmsHalPublisherListener listener) { |
| 112 | mPublisherListeners.add(listener); |
Antonio Cortes | 40b9026 | 2017-02-06 11:43:57 -0800 | [diff] [blame] | 113 | } |
| 114 | |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 115 | public void addSubscriberListener(VmsHalSubscriberListener listener) { |
| 116 | mSubscriberListeners.add(listener); |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 117 | } |
| 118 | |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 119 | public void removePublisherListener(VmsHalPublisherListener listener) { |
| 120 | mPublisherListeners.remove(listener); |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 121 | } |
| 122 | |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 123 | public void removeSubscriberListener(VmsHalSubscriberListener listener) { |
| 124 | mSubscriberListeners.remove(listener); |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 125 | } |
| 126 | |
Asaf Rosenfeld | 2ca6f8c | 2017-03-20 12:59:33 -0700 | [diff] [blame] | 127 | public void addSubscription(IVmsSubscriberClient listener, VmsLayer layer) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 128 | boolean firstSubscriptionForLayer = false; |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 129 | synchronized (mLock) { |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 130 | // Check if publishers need to be notified about this change in subscriptions. |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 131 | firstSubscriptionForLayer = !mRouting.hasLayerSubscriptions(layer); |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 132 | |
| 133 | // Add the listeners subscription to the layer |
| 134 | mRouting.addSubscription(listener, layer); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 135 | } |
| 136 | if (firstSubscriptionForLayer) { |
| 137 | notifyPublishers(layer, true); |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 138 | } |
| 139 | } |
| 140 | |
Asaf Rosenfeld | 2ca6f8c | 2017-03-20 12:59:33 -0700 | [diff] [blame] | 141 | public void removeSubscription(IVmsSubscriberClient listener, VmsLayer layer) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 142 | boolean layerHasSubscribers = true; |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 143 | synchronized (mLock) { |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 144 | if (!mRouting.hasLayerSubscriptions(layer)) { |
| 145 | Log.i(TAG, "Trying to remove a layer with no subscription: " + layer); |
| 146 | return; |
| 147 | } |
| 148 | |
| 149 | // Remove the listeners subscription to the layer |
| 150 | mRouting.removeSubscription(listener, layer); |
| 151 | |
| 152 | // Check if publishers need to be notified about this change in subscriptions. |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 153 | layerHasSubscribers = mRouting.hasLayerSubscriptions(layer); |
| 154 | } |
| 155 | if (!layerHasSubscribers) { |
| 156 | notifyPublishers(layer, false); |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 157 | } |
| 158 | } |
| 159 | |
Asaf Rosenfeld | 2ca6f8c | 2017-03-20 12:59:33 -0700 | [diff] [blame] | 160 | public void addSubscription(IVmsSubscriberClient listener) { |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 161 | synchronized (mLock) { |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 162 | mRouting.addSubscription(listener); |
| 163 | } |
| 164 | } |
| 165 | |
Asaf Rosenfeld | 2ca6f8c | 2017-03-20 12:59:33 -0700 | [diff] [blame] | 166 | public void removeSubscription(IVmsSubscriberClient listener) { |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 167 | synchronized (mLock) { |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 168 | mRouting.removeSubscription(listener); |
| 169 | } |
| 170 | } |
| 171 | |
Asaf Rosenfeld | 2ca6f8c | 2017-03-20 12:59:33 -0700 | [diff] [blame] | 172 | public void removeDeadListener(IVmsSubscriberClient listener) { |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 173 | synchronized (mLock) { |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 174 | mRouting.removeDeadListener(listener); |
| 175 | } |
| 176 | } |
| 177 | |
Asaf Rosenfeld | 2ca6f8c | 2017-03-20 12:59:33 -0700 | [diff] [blame] | 178 | public Set<IVmsSubscriberClient> getListeners(VmsLayer layer) { |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 179 | synchronized (mLock) { |
Antonio Cortes | 8b35009 | 2017-03-16 16:02:51 -0700 | [diff] [blame] | 180 | return mRouting.getListeners(layer); |
| 181 | } |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 182 | } |
| 183 | |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 184 | public Set<IVmsSubscriberClient> getAllListeners() { |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 185 | synchronized (mLock) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 186 | return mRouting.getAllListeners(); |
| 187 | } |
| 188 | } |
| 189 | |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 190 | public boolean isHalSubscribed(VmsLayer layer) { |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 191 | synchronized (mLock) { |
Antonio Cortes | 8b35009 | 2017-03-16 16:02:51 -0700 | [diff] [blame] | 192 | return mRouting.isHalSubscribed(layer); |
| 193 | } |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 194 | } |
| 195 | |
Antonio Cortes | 2febe9f | 2017-03-24 09:42:17 -0700 | [diff] [blame] | 196 | public VmsSubscriptionState getSubscriptionState() { |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 197 | synchronized (mLock) { |
Antonio Cortes | 2febe9f | 2017-03-24 09:42:17 -0700 | [diff] [blame] | 198 | return mRouting.getSubscriptionState(); |
Antonio Cortes | 8b35009 | 2017-03-16 16:02:51 -0700 | [diff] [blame] | 199 | } |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 200 | } |
| 201 | |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 202 | /** |
| 203 | * Assigns an idempotent ID for publisherInfo and stores it. The idempotency in this case means |
| 204 | * that the same publisherInfo will always, within a trip of the vehicle, return the same ID. |
| 205 | * The publisherInfo should be static for a binary and should only change as part of a software |
| 206 | * update. The publisherInfo is a serialized proto message which VMS clients can interpret. |
| 207 | */ |
| 208 | public int getPublisherStaticId(byte[] publisherInfo) { |
| 209 | if (DBG) { |
| 210 | Log.i(TAG, "Getting publisher static ID"); |
| 211 | } |
| 212 | synchronized (mLock) { |
| 213 | return mPublishersInfo.getIdForInfo(publisherInfo); |
| 214 | } |
| 215 | } |
| 216 | |
| 217 | public byte[] getPublisherInfo(int publisherId) { |
| 218 | if (DBG) { |
| 219 | Log.i(TAG, "Getting information for publisher ID: " + publisherId); |
| 220 | } |
| 221 | synchronized (mLock) { |
| 222 | return mPublishersInfo.getPublisherInfo(publisherId); |
| 223 | } |
| 224 | } |
| 225 | |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 226 | public void addHalSubscription(VmsLayer layer) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 227 | boolean firstSubscriptionForLayer = true; |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 228 | synchronized (mLock) { |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 229 | // Check if publishers need to be notified about this change in subscriptions. |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 230 | firstSubscriptionForLayer = !mRouting.hasLayerSubscriptions(layer); |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 231 | |
| 232 | // Add the listeners subscription to the layer |
| 233 | mRouting.addHalSubscription(layer); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 234 | } |
| 235 | if (firstSubscriptionForLayer) { |
| 236 | notifyPublishers(layer, true); |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 237 | } |
| 238 | } |
| 239 | |
| 240 | public void removeHalSubscription(VmsLayer layer) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 241 | boolean layerHasSubscribers = true; |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 242 | synchronized (mLock) { |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 243 | if (!mRouting.hasLayerSubscriptions(layer)) { |
| 244 | Log.i(TAG, "Trying to remove a layer with no subscription: " + layer); |
| 245 | return; |
| 246 | } |
| 247 | |
| 248 | // Remove the listeners subscription to the layer |
| 249 | mRouting.removeHalSubscription(layer); |
| 250 | |
| 251 | // Check if publishers need to be notified about this change in subscriptions. |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 252 | layerHasSubscribers = mRouting.hasLayerSubscriptions(layer); |
| 253 | } |
| 254 | if (!layerHasSubscribers) { |
| 255 | notifyPublishers(layer, false); |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 256 | } |
| 257 | } |
| 258 | |
Asaf Rosenfeld | 2ca6f8c | 2017-03-20 12:59:33 -0700 | [diff] [blame] | 259 | public boolean containsListener(IVmsSubscriberClient listener) { |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 260 | synchronized (mLock) { |
Antonio Cortes | 8b35009 | 2017-03-16 16:02:51 -0700 | [diff] [blame] | 261 | return mRouting.containsListener(listener); |
| 262 | } |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 263 | } |
| 264 | |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 265 | public void setPublisherLayersOffering(IBinder publisherToken, VmsLayersOffering offering){ |
| 266 | Set<VmsLayer> availableLayers = Collections.EMPTY_SET; |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 267 | synchronized (mLock) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 268 | updateOffering(publisherToken, offering); |
| 269 | availableLayers = mAvailableLayers.getAvailableLayers(); |
| 270 | } |
| 271 | notifySubscribers(availableLayers); |
| 272 | } |
| 273 | |
| 274 | public Set<VmsLayer> getAvailableLayers() { |
| 275 | //TODO(b/36872877): wrap available layers in VmsAvailabilityState similar to VmsSubscriptionState. |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 276 | synchronized (mLock) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 277 | return mAvailableLayers.getAvailableLayers(); |
| 278 | } |
| 279 | } |
| 280 | |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 281 | /** |
| 282 | * Notify all the publishers and the HAL on subscription changes regardless of who triggered |
| 283 | * the change. |
| 284 | * |
Antonio Cortes | 9db963a | 2017-03-10 15:15:28 -0800 | [diff] [blame] | 285 | * @param layer layer which is being subscribed to or unsubscribed from. |
| 286 | * @param hasSubscribers indicates if the notification is for subscription or unsubscription. |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 287 | */ |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 288 | private void notifyPublishers(VmsLayer layer, boolean hasSubscribers) { |
| 289 | // notify the HAL |
| 290 | setSubscriptionRequest(layer, hasSubscribers); |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 291 | |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 292 | // Notify the App publishers |
| 293 | for (VmsHalPublisherListener listener : mPublisherListeners) { |
| 294 | // Besides the list of layers, also a timestamp is provided to the clients. |
| 295 | // They should ignore any notification with a timestamp that is older than the most |
| 296 | // recent timestamp they have seen. |
| 297 | listener.onChange(getSubscriptionState()); |
| 298 | } |
| 299 | } |
| 300 | |
| 301 | /** |
| 302 | * Notify all the subscribers and the HAL on layers availability change. |
| 303 | * |
| 304 | * @param availableLayers the layers which publishers claim they made publish. |
| 305 | */ |
| 306 | private void notifySubscribers(Set<VmsLayer> availableLayers) { |
| 307 | // notify the HAL |
| 308 | setAvailableLayers(availableLayers); |
| 309 | |
| 310 | // Notify the App subscribers |
| 311 | for (VmsHalSubscriberListener listener : mSubscriberListeners) { |
| 312 | listener.onLayersAvaiabilityChange(new ArrayList<>(availableLayers)); |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 313 | } |
| 314 | } |
| 315 | |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 316 | @Override |
| 317 | public void init() { |
| 318 | if (DBG) { |
| 319 | Log.d(TAG, "init()"); |
| 320 | } |
| 321 | if (mIsSupported) { |
Pavel Maltsev | 79d5e12 | 2017-03-24 12:46:40 -0700 | [diff] [blame] | 322 | mVehicleHal.subscribeProperty(this, HAL_PROPERTY_ID); |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 323 | } |
| 324 | } |
| 325 | |
| 326 | @Override |
| 327 | public void release() { |
| 328 | if (DBG) { |
| 329 | Log.d(TAG, "release()"); |
| 330 | } |
| 331 | if (mIsSupported) { |
| 332 | mVehicleHal.unsubscribeProperty(this, HAL_PROPERTY_ID); |
| 333 | } |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 334 | mPublisherListeners.clear(); |
| 335 | mSubscriberListeners.clear(); |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 336 | } |
| 337 | |
| 338 | @Override |
| 339 | public Collection<VehiclePropConfig> takeSupportedProperties( |
| 340 | Collection<VehiclePropConfig> allProperties) { |
| 341 | List<VehiclePropConfig> taken = new LinkedList<>(); |
| 342 | for (VehiclePropConfig p : allProperties) { |
| 343 | if (p.prop == HAL_PROPERTY_ID) { |
| 344 | taken.add(p); |
| 345 | mIsSupported = true; |
| 346 | if (DBG) { |
| 347 | Log.d(TAG, "takeSupportedProperties: " + toHexString(p.prop)); |
| 348 | } |
| 349 | break; |
| 350 | } |
| 351 | } |
| 352 | return taken; |
| 353 | } |
| 354 | |
Antonio Cortes | e0824d7 | 2017-04-06 11:13:35 -0700 | [diff] [blame] | 355 | /** |
| 356 | * Consumes/produces HAL messages. The format of these messages is defined in: |
| 357 | * hardware/interfaces/automotive/vehicle/2.1/types.hal |
| 358 | */ |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 359 | @Override |
| 360 | public void handleHalEvents(List<VehiclePropValue> values) { |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 361 | if (DBG) { |
| 362 | Log.d(TAG, "Handling a VMS property change"); |
| 363 | } |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 364 | for (VehiclePropValue v : values) { |
| 365 | ArrayList<Integer> vec = v.value.int32Values; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 366 | int messageType = vec.get(VmsBaseMessageIntegerValuesIndex.VMS_MESSAGE_TYPE); |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 367 | |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 368 | if (DBG) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 369 | Log.d(TAG, "Handling VMS message type: " + messageType); |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 370 | } |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 371 | switch(messageType) { |
| 372 | case VmsMessageType.DATA: |
| 373 | handleDataEvent(vec, toByteArray(v.value.bytes)); |
| 374 | break; |
| 375 | case VmsMessageType.SUBSCRIBE: |
| 376 | handleSubscribeEvent(vec); |
| 377 | break; |
| 378 | case VmsMessageType.UNSUBSCRIBE: |
| 379 | handleUnsubscribeEvent(vec); |
| 380 | break; |
| 381 | case VmsMessageType.OFFERING: |
| 382 | handleOfferingEvent(vec); |
| 383 | break; |
Asaf Rosenfeld | 1ab389c | 2017-04-25 11:24:17 -0700 | [diff] [blame] | 384 | case VmsMessageType.AVAILABILITY_REQUEST: |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 385 | handleAvailabilityEvent(); |
| 386 | break; |
Antonio Cortes | e0824d7 | 2017-04-06 11:13:35 -0700 | [diff] [blame] | 387 | case VmsMessageType.SUBSCRIPTION_REQUEST: |
| 388 | handleSubscriptionRequestEvent(); |
| 389 | break; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 390 | default: |
| 391 | throw new IllegalArgumentException("Unexpected message type: " + messageType); |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 392 | } |
| 393 | } |
| 394 | } |
| 395 | |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 396 | private VmsLayer parseVmsLayerFromSimpleMessageIntegerValues(List<Integer> integerValues) { |
| 397 | return new VmsLayer(integerValues.get(VmsSimpleMessageIntegerValuesIndex.VMS_LAYER_ID), |
| 398 | integerValues.get(VmsSimpleMessageIntegerValuesIndex.VMS_LAYER_VERSION), |
| 399 | integerValues.get(VmsSimpleMessageIntegerValuesIndex.VMS_LAYER_SUB_TYPE)); |
| 400 | } |
| 401 | |
Antonio Cortes | e0824d7 | 2017-04-06 11:13:35 -0700 | [diff] [blame] | 402 | /** |
| 403 | * Data message format: |
| 404 | * <ul> |
| 405 | * <li>Message type. |
| 406 | * <li>Layer id. |
| 407 | * <li>Layer version. |
| 408 | * <li>Payload. |
| 409 | * </ul> |
| 410 | */ |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 411 | private void handleDataEvent(List<Integer> integerValues, byte[] payload) { |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 412 | VmsLayer vmsLayer = parseVmsLayerFromSimpleMessageIntegerValues(integerValues); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 413 | if (DBG) { |
| 414 | Log.d(TAG, |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 415 | "Handling a data event for Layer: " + vmsLayer); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 416 | } |
| 417 | |
| 418 | // Send the message. |
| 419 | for (VmsHalSubscriberListener listener : mSubscriberListeners) { |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 420 | listener.onDataMessage(vmsLayer, payload); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 421 | } |
| 422 | } |
| 423 | |
Antonio Cortes | e0824d7 | 2017-04-06 11:13:35 -0700 | [diff] [blame] | 424 | /** |
| 425 | * Subscribe message format: |
| 426 | * <ul> |
| 427 | * <li>Message type. |
| 428 | * <li>Layer id. |
| 429 | * <li>Layer version. |
| 430 | * </ul> |
| 431 | */ |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 432 | private void handleSubscribeEvent(List<Integer> integerValues) { |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 433 | VmsLayer vmsLayer = parseVmsLayerFromSimpleMessageIntegerValues(integerValues); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 434 | if (DBG) { |
| 435 | Log.d(TAG, |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 436 | "Handling a subscribe event for Layer: " + vmsLayer); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 437 | } |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 438 | addHalSubscription(vmsLayer); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 439 | } |
| 440 | |
Antonio Cortes | e0824d7 | 2017-04-06 11:13:35 -0700 | [diff] [blame] | 441 | /** |
| 442 | * Unsubscribe message format: |
| 443 | * <ul> |
| 444 | * <li>Message type. |
| 445 | * <li>Layer id. |
| 446 | * <li>Layer version. |
| 447 | * </ul> |
| 448 | */ |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 449 | private void handleUnsubscribeEvent(List<Integer> integerValues) { |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 450 | VmsLayer vmsLayer = parseVmsLayerFromSimpleMessageIntegerValues(integerValues); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 451 | if (DBG) { |
| 452 | Log.d(TAG, |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 453 | "Handling an unsubscribe event for Layer: " + vmsLayer); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 454 | } |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 455 | removeHalSubscription(vmsLayer); |
| 456 | } |
| 457 | |
| 458 | private static int NUM_INTEGERS_IN_VMS_LAYER = 3; |
| 459 | |
| 460 | private VmsLayer parseVmsLayerFromIndex(List<Integer> integerValues, int index) { |
| 461 | return new VmsLayer(integerValues.get(index++), |
| 462 | integerValues.get(index++), |
| 463 | integerValues.get(index++)); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 464 | } |
| 465 | |
Antonio Cortes | e0824d7 | 2017-04-06 11:13:35 -0700 | [diff] [blame] | 466 | /** |
| 467 | * Offering message format: |
| 468 | * <ul> |
| 469 | * <li>Message type. |
| 470 | * <li>Number of offerings. |
| 471 | * <li>Each offering consists of: |
| 472 | * <ul> |
| 473 | * <li>Layer id. |
| 474 | * <li>Layer version. |
| 475 | * <li>Number of layer dependencies. |
| 476 | * <li>Layer type/version pairs. |
| 477 | * </ul> |
| 478 | * </ul> |
| 479 | */ |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 480 | private void handleOfferingEvent(List<Integer> integerValues) { |
| 481 | int numLayersDependencies = |
| 482 | integerValues.get(VmsOfferingMessageIntegerValuesIndex.VMS_NUMBER_OF_LAYERS_DEPENDENCIES); |
| 483 | int idx = VmsOfferingMessageIntegerValuesIndex.FIRST_DEPENDENCIES_INDEX; |
| 484 | |
| 485 | List<VmsLayerDependency> offeredLayers = new ArrayList<>(); |
| 486 | |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 487 | // An offering is layerId, LayerVersion, LayerType, NumDeps, <LayerId, LayerVersion> X NumDeps. |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 488 | for (int i = 0; i < numLayersDependencies; i++) { |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 489 | VmsLayer offeredLayer = parseVmsLayerFromIndex(integerValues, idx); |
| 490 | idx += NUM_INTEGERS_IN_VMS_LAYER; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 491 | |
| 492 | int numDependenciesForLayer = integerValues.get(idx++); |
| 493 | if (numDependenciesForLayer == 0) { |
| 494 | offeredLayers.add(new VmsLayerDependency(offeredLayer)); |
| 495 | } else { |
| 496 | Set<VmsLayer> dependencies = new HashSet<>(); |
| 497 | |
| 498 | for (int j = 0; j < numDependenciesForLayer; j++) { |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 499 | VmsLayer dependantLayer = parseVmsLayerFromIndex(integerValues, idx); |
| 500 | idx += NUM_INTEGERS_IN_VMS_LAYER; |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 501 | dependencies.add(dependantLayer); |
| 502 | } |
| 503 | offeredLayers.add(new VmsLayerDependency(offeredLayer, dependencies)); |
| 504 | } |
| 505 | } |
| 506 | // Store the HAL offering. |
| 507 | VmsLayersOffering offering = new VmsLayersOffering(offeredLayers); |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 508 | synchronized (mLock) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 509 | updateOffering(mHalPublisherToken, offering); |
| 510 | } |
| 511 | } |
| 512 | |
Antonio Cortes | e0824d7 | 2017-04-06 11:13:35 -0700 | [diff] [blame] | 513 | /** |
| 514 | * Availability message format: |
| 515 | * <ul> |
| 516 | * <li>Message type. |
| 517 | * <li>Number of layers. |
| 518 | * <li>Layer type/version pairs. |
| 519 | * </ul> |
| 520 | */ |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 521 | private void handleAvailabilityEvent() { |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 522 | synchronized (mLock) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 523 | Collection<VmsLayer> availableLayers = mAvailableLayers.getAvailableLayers(); |
| 524 | VehiclePropValue vehiclePropertyValue = toVehiclePropValue( |
Asaf Rosenfeld | 1ab389c | 2017-04-25 11:24:17 -0700 | [diff] [blame] | 525 | VmsMessageType.AVAILABILITY_RESPONSE, availableLayers); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 526 | setPropertyValue(vehiclePropertyValue); |
| 527 | } |
| 528 | } |
| 529 | |
Antonio Cortes | e0824d7 | 2017-04-06 11:13:35 -0700 | [diff] [blame] | 530 | /** |
| 531 | * VmsSubscriptionRequestFormat: |
| 532 | * <ul> |
| 533 | * <li>Message type. |
| 534 | * </ul> |
| 535 | * |
| 536 | * VmsSubscriptionResponseFormat: |
| 537 | * <ul> |
| 538 | * <li>Message type. |
| 539 | * <li>Sequence number. |
| 540 | * <li>Number of layers. |
| 541 | * <li>Layer type/version pairs. |
| 542 | * </ul> |
| 543 | */ |
| 544 | private void handleSubscriptionRequestEvent() { |
| 545 | VmsSubscriptionState subscription = getSubscriptionState(); |
| 546 | VehiclePropValue vehicleProp = toVehiclePropValue(VmsMessageType.SUBSCRIPTION_RESPONSE); |
| 547 | VehiclePropValue.RawValue v = vehicleProp.value; |
| 548 | v.int32Values.add(subscription.getSequenceNumber()); |
| 549 | List<VmsLayer> layers = subscription.getLayers(); |
| 550 | v.int32Values.add(layers.size()); |
| 551 | for (VmsLayer layer : layers) { |
| 552 | v.int32Values.add(layer.getId()); |
| 553 | v.int32Values.add(layer.getVersion()); |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 554 | v.int32Values.add(layer.getSubType()); |
Antonio Cortes | e0824d7 | 2017-04-06 11:13:35 -0700 | [diff] [blame] | 555 | } |
| 556 | setPropertyValue(vehicleProp); |
| 557 | } |
| 558 | |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 559 | private void updateOffering(IBinder publisherToken, VmsLayersOffering offering) { |
| 560 | Set<VmsLayer> availableLayers = Collections.EMPTY_SET; |
Asaf Rosenfeld | 6028489 | 2017-05-19 12:59:56 -0700 | [diff] [blame] | 561 | synchronized (mLock) { |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 562 | mOfferings.put(publisherToken, offering); |
| 563 | |
| 564 | // Update layers availability. |
| 565 | mAvailableLayers.setPublishersOffering(mOfferings.values()); |
| 566 | |
| 567 | availableLayers = mAvailableLayers.getAvailableLayers(); |
| 568 | } |
| 569 | notifySubscribers(availableLayers); |
| 570 | } |
| 571 | |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 572 | @Override |
| 573 | public void dump(PrintWriter writer) { |
| 574 | writer.println(TAG); |
| 575 | writer.println("VmsProperty " + (mIsSupported ? "" : "not") + " supported."); |
| 576 | } |
| 577 | |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 578 | /** |
| 579 | * Updates the VMS HAL property with the given value. |
| 580 | * |
Antonio Cortes | 01a6039 | 2017-03-22 13:00:02 -0700 | [diff] [blame] | 581 | * @param layer layer data to update the hal property. |
| 582 | * @param hasSubscribers if it is a subscribe or unsubscribe message. |
| 583 | * @return true if the call to the HAL to update the property was successful. |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 584 | */ |
Antonio Cortes | 01a6039 | 2017-03-22 13:00:02 -0700 | [diff] [blame] | 585 | public boolean setSubscriptionRequest(VmsLayer layer, boolean hasSubscribers) { |
asafro | 25a8740 | 2017-02-28 16:08:17 -0800 | [diff] [blame] | 586 | VehiclePropValue vehiclePropertyValue = toVehiclePropValue( |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 587 | hasSubscribers ? VmsMessageType.SUBSCRIBE : VmsMessageType.UNSUBSCRIBE, layer); |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 588 | return setPropertyValue(vehiclePropertyValue); |
| 589 | } |
| 590 | |
Antonio Cortes | 01a6039 | 2017-03-22 13:00:02 -0700 | [diff] [blame] | 591 | public boolean setDataMessage(VmsLayer layer, byte[] payload) { |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 592 | VehiclePropValue vehiclePropertyValue = toVehiclePropValue(VmsMessageType.DATA, |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 593 | layer, |
| 594 | payload); |
| 595 | return setPropertyValue(vehiclePropertyValue); |
| 596 | } |
| 597 | |
| 598 | public boolean setAvailableLayers(Collection<VmsLayer> availableLayers) { |
Asaf Rosenfeld | 1ab389c | 2017-04-25 11:24:17 -0700 | [diff] [blame] | 599 | VehiclePropValue vehiclePropertyValue = |
| 600 | toVehiclePropValue(VmsMessageType.AVAILABILITY_RESPONSE, |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 601 | availableLayers); |
| 602 | |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 603 | return setPropertyValue(vehiclePropertyValue); |
| 604 | } |
| 605 | |
| 606 | public boolean setPropertyValue(VehiclePropValue vehiclePropertyValue) { |
| 607 | try { |
| 608 | mVehicleHal.set(vehiclePropertyValue); |
| 609 | return true; |
| 610 | } catch (PropertyTimeoutException e) { |
| 611 | Log.e(CarLog.TAG_PROPERTY, "set, property not ready 0x" + toHexString(HAL_PROPERTY_ID)); |
| 612 | } |
| 613 | return false; |
| 614 | } |
| 615 | |
| 616 | /** Creates a {@link VehiclePropValue} */ |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 617 | private static VehiclePropValue toVehiclePropValue(int messageType) { |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 618 | VehiclePropValue vehicleProp = new VehiclePropValue(); |
| 619 | vehicleProp.prop = HAL_PROPERTY_ID; |
| 620 | vehicleProp.areaId = VehicleAreaType.VEHICLE_AREA_TYPE_NONE; |
| 621 | VehiclePropValue.RawValue v = vehicleProp.value; |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 622 | |
| 623 | v.int32Values.add(messageType); |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 624 | return vehicleProp; |
| 625 | } |
| 626 | |
| 627 | /** Creates a {@link VehiclePropValue} */ |
| 628 | private static VehiclePropValue toVehiclePropValue(int messageType, VmsLayer layer) { |
| 629 | VehiclePropValue vehicleProp = toVehiclePropValue(messageType); |
| 630 | VehiclePropValue.RawValue v = vehicleProp.value; |
Antonio Cortes | 01a6039 | 2017-03-22 13:00:02 -0700 | [diff] [blame] | 631 | v.int32Values.add(layer.getId()); |
| 632 | v.int32Values.add(layer.getVersion()); |
Asaf Rosenfeld | bcf7df1 | 2017-06-02 18:31:28 -0700 | [diff] [blame^] | 633 | v.int32Values.add(layer.getSubType()); |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 634 | return vehicleProp; |
| 635 | } |
| 636 | |
Antonio Cortes | 01a6039 | 2017-03-22 13:00:02 -0700 | [diff] [blame] | 637 | /** Creates a {@link VehiclePropValue} with payload */ |
| 638 | private static VehiclePropValue toVehiclePropValue(int messageType, |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 639 | VmsLayer layer, |
| 640 | byte[] payload) { |
Antonio Cortes | 01a6039 | 2017-03-22 13:00:02 -0700 | [diff] [blame] | 641 | VehiclePropValue vehicleProp = toVehiclePropValue(messageType, layer); |
asafro | 99e4f08 | 2017-02-09 13:11:42 -0800 | [diff] [blame] | 642 | VehiclePropValue.RawValue v = vehicleProp.value; |
| 643 | v.bytes.ensureCapacity(payload.length); |
| 644 | for (byte b : payload) { |
| 645 | v.bytes.add(b); |
| 646 | } |
Antonio Cortes | 734010a | 2017-01-19 20:09:22 -0800 | [diff] [blame] | 647 | return vehicleProp; |
| 648 | } |
Asaf Rosenfeld | eb541d4 | 2017-03-31 14:32:10 -0700 | [diff] [blame] | 649 | |
| 650 | /** Creates a {@link VehiclePropValue} with payload */ |
| 651 | private static VehiclePropValue toVehiclePropValue(int messageType, |
| 652 | Collection<VmsLayer> layers) { |
| 653 | VehiclePropValue vehicleProp = toVehiclePropValue(messageType); |
| 654 | VehiclePropValue.RawValue v = vehicleProp.value; |
| 655 | int numLayers = layers.size(); |
| 656 | v.int32Values.add(numLayers); |
| 657 | for (VmsLayer layer : layers) { |
| 658 | v.int32Values.add(layer.getId()); |
| 659 | v.int32Values.add(layer.getVersion()); |
| 660 | } |
| 661 | return vehicleProp; |
| 662 | } |
| 663 | } |