Tests added
Incorrect speed sign after rotation through zero degrees fixed