Implemented velocity encoder mode