Fixed all the bugs and...

Started to work effectively to RoboticStaff 2.0
At least, that's what I think.