TinyG buffer improvement for no thread blocking