Fixed math (?) and draw robot as box with actual dimensions.
Added thread to get network tables values
Added Robot class to handle drawing of robot.