pfilt

	
# pfilt - a function that returns a signal for extracting scalogram values based on harmonic filter
#			and desired frequency band width for each of the four harmonics
# December 6, 2013
# Copyright (C) 2014 Christian Richard

# This program is free software: you can redistribute it and/or modify
# it under the terms of the GNU General Public License as published by
# the Free Software Foundation, either version 3 of the License, or
# (at your option) any later version.

# This program is distributed in the hope that it will be useful,
# but WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
# GNU General Public License for more details.

# You should have received a copy of the GNU General Public License
# along with this program.  If not, see <http://www.gnu.org/licenses/gpl.html>. 

# Author contact info:
# lifepupil@gmail.com

#~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~


setproc pfilt {{&signal harmonicPos} {&signal lowerFwidth} {&signal upperFwidth}} {

	rangeSum = sum(lowerFwidth)+sum(upperFwidth)+harmonicPos.size
	ridgeFilter = Zero(rangeSum)
	
	shift = 0
	
	foreach i 0:harmonicPos.size-1 {
		# indices for ith harmonic
		hIndices = <harmonicPos[i]-lowerFwidth[i]:harmonicPos[i]+upperFwidth[i]>
		hiRng = hIndices.X[@<]:hIndices.X[@>]
		shifted_hiRng = hiRng+shift
		shift += hIndices.size
		
		start = shifted_hiRng[@<]
		end = shifted_hiRng[@>]
		ridgeFilter[start:end] = hIndices
	}
	
	return ridgeFilter
}