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/