modifying testVision command and Vision subsystem. adding get distantce, get targetType, etc as methods in vision so can be used seperatly.