added documentation
Added robotInit function and Test Period.