Better Vision Data: Random Robot Poses!

[ysims]

At the moment the vision data collection only changes the head and arm poses of the NUgus that is collecting data.

We would like to vary our data more by moving the rest of the robots' joints! Probably some sort of while loop over all other objects that are robots (check node type), and move their joints randomly between the joint's max and min position (should be readable!).

Not necessarily required, but would be nice to find a better way to move the motors. At the moment it sets the position and waits a fixed amount of time for it to move. Checking if it's reached the position doesn't directly work because sometimes the motors cannot move further because of collision. Some way to snap the motor or make it move faster would be good (without collision).

Needs #64 merged first.