Personally, I would suggest using a different prgramming language than the LEGO one. Not Quite C (NQC) is a very versital language that is a lot more powerful than the standard one. Plus, it is sort of a C derivitive, so if you already know C that great.
http://bricxcc.sourceforge.net/nqc/