Add unit tests
Add unit tests

Change-Id: I9deee649b32dd97ab8a1ac850b6857ea9da223d1
GitOrigin-RevId: e392a3c1e048581cae6e63a27208a23d89a4c0e2

googlecloudrobotics/core,googlecloudrobotics/core,googlecloudrobotics/core