Use REP103 SI Units/Convention #22

Need to make a pass over the whole system (internal calculations, state data, published messages) to make sure we are consistent with ROS2 standard SI units and conventions: REP103