Fixed stuff

Signed-off-by: Eric Summs <esumsroboticsteam@gmail.com>