Initial code import.

Signed-off-by: Brett Hagman <bhagman@roguerobotics.com>
(bhagman-ws1)