Highlighting the heading to scroll to is a must.
It’s what headings maps extension does when you click on one [0].
[0]: https://addons.mozilla.org/en-US/firefox/addon/headingsmap/