Стой, ты прыгаешь через важные пункты
Давай проинвентаризируем до куда договорились:
Пакет состоит из:
1. Идентификатор датчика;
2. Время снятия показаний;
3. Положение датчика в этот момент времени в локальной системе координат (если оно может меняться, иначе пусто);
4. Список информации о расстоянии;
5. Список информации о информации о расстоянии - достоверность в % (если 0% - значит не смогли определить);
Кроме пакета должна быть информация о датчике:
1. Идентификатор датчика;
2. Положение датчика на роботе в локальной системе координат (если оно не может меняться, иначе пусто);
3. Список информации о структуре датчика - вектора направлений будущих измерений в локальных координатах датчика, угол в котором могут оказаться препятствия, минимальная и максимальная дальность обнаружаемых препятствий.
Как-то так?