New classes and small changes

Motorcontroller is based on David Gilday s motor controller  from the
mindcuber project.
Its also a motor controller in nxcBoost library.
NQueue is really basic and light/fast.