Draft: Improve `_peak_position`
Description
Improve _peak_position and add tests
How Has This Been Tested?
Relevant Documents (optional)
Types of changes
- New feature (non-breaking change which adds functionality)
- Refactor (refactoring code with no functionality changes)
- Test (additional or refactored tests)