ll40ls: Fix LIDAR-Lite v3 initialization

[dvornikov-aa]

The current initialisation code works only if every UID byte contains a non-zero value. According to the manual UNIT_ID is a unique value without any restrictions.

[dagar]

@mcsauder do you have one of these to test?

[mcsauder]

Hi @dagar , I do. No errors on startup and bench tests look fine.

Bench test of this PR:

Bench test of PX4:master:

[mcsauder]

Here is a capture at boot adding in printout to that logic block for your convenience, (succeeds on bus 3):

Behavior is identical to PX4:master when the same printout is added to master:

[DanielePettenuzzo]

@dvornikov-aa Did you find a sensor with id equal to 0? Anyway looks good although currently the lidar lite v3 HP seems to be broken so anyway things might slightly change in the probe in the near future. @cmic0 and I are looking for a proper fix to support all the lidar lites

[dvornikov-aa]

@DanielePettenuzzo It's not just about one UID. We lose all UIDs where one of the octets (!) is zero.

By the way, I do have a sensor with UID = 0. I've checked UNIT_ID_HIGH and UNIT_ID_LOW using Pixhawk 2 and Raspberry Pi.