Updated DriveControl (and unit test)

Use SafetySensorCanPayloadTranslator instead of Boolean