Nice progress :)
I see you still have the touch and colour sensors in there, but I think you're not using them any more, is that correct?
And at the moment, the Mindstorm controller seems to be at a fixed angle to the "forearm", i.e no joint 3 from your list in the original post. Will you change that for more articulation?