Incremental encoder reading added