Implemented code to plot points on brick's screen.

The code however is not tested, although it compiles fine.

The current solution however requires us to put calls to the
plotPosition() whenever we want to display it on the brick's
screen. A better solution might be to create a separate thread??
that does this trick without us having to mess about and call
plotPosition().