Added robotstate class. wrote goalseen callback