Unipolar, posiotion

Unipolar motor code,
Position read
Bug fixes