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