// Copyright 2017 The Ebiten Authors // // Licensed under the Apache License, Version 2.0 (the "License"); // you may not use this file except in compliance with the License. // You may obtain a copy of the License at // // http://www.apache.org/licenses/LICENSE-2.0 // // Unless required by applicable law or agreed to in writing, software // distributed under the License is distributed on an "AS IS" BASIS, // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. // See the License for the specific language governing permissions and // limitations under the License. package convert import ( "io" "math" "sync" ) var ( // cosTable contains values of cosine applied to the range [0, π/2). // It must be initialised the first time it is referenced // in a function via its lazy load wrapper getCosTable(). cosTable []float64 cosTableOnce sync.Once ) func ensureCosTable() []float64 { cosTableOnce.Do(func() { cosTable = make([]float64, 65536) for i := range cosTable { cosTable[i] = math.Cos(float64(i) * math.Pi / 2 / float64(len(cosTable))) } }) return cosTable } func fastCos01(x float64) float64 { if x < 0 { x = -x } cosTable := ensureCosTable() i := int(4 * float64(len(cosTable)) * x) if 4*len(cosTable) < i { i %= 4 * len(cosTable) } sign := 1 switch { case i < len(cosTable): case i < len(cosTable)*2: i = len(cosTable)*2 - i sign = -1 case i < len(cosTable)*3: i -= len(cosTable) * 2 sign = -1 default: i = len(cosTable)*4 - i } if i == len(cosTable) { return 0 } return float64(sign) * cosTable[i] } func fastSin01(x float64) float64 { return fastCos01(x - 0.25) } func sinc01(x float64) float64 { if math.Abs(x) < 1e-8 { return 1 } return fastSin01(x) / (x * 2 * math.Pi) } type Resampling struct { source io.ReadSeeker size int64 from int to int pos int64 srcBlock int64 srcBufL map[int64][]float64 srcBufR map[int64][]float64 lruSrcBlocks []int64 } func NewResampling(source io.ReadSeeker, size int64, from, to int) *Resampling { r := &Resampling{ source: source, size: size, from: from, to: to, srcBlock: -1, srcBufL: map[int64][]float64{}, srcBufR: map[int64][]float64{}, } return r } func (r *Resampling) Length() int64 { s := int64(float64(r.size) * float64(r.to) / float64(r.from)) return s / 4 * 4 } func (r *Resampling) src(i int64) (float64, float64, error) { const resamplingBufferSize = 4096 if i < 0 { return 0, 0, nil } if r.size/4 <= i { return 0, 0, nil } nextPos := int64(i) / resamplingBufferSize if _, ok := r.srcBufL[nextPos]; !ok { if r.srcBlock+1 != nextPos { if _, err := r.source.Seek(nextPos*resamplingBufferSize*4, io.SeekStart); err != nil { return 0, 0, err } } buf := make([]byte, resamplingBufferSize*4) c := 0 for c < len(buf) { n, err := r.source.Read(buf[c:]) c += n if err != nil { if err == io.EOF { break } return 0, 0, err } } buf = buf[:c] sl := make([]float64, resamplingBufferSize) sr := make([]float64, resamplingBufferSize) for i := 0; i < len(buf)/4; i++ { sl[i] = float64(int16(buf[4*i])|(int16(buf[4*i+1])<<8)) / (1<<15 - 1) sr[i] = float64(int16(buf[4*i+2])|(int16(buf[4*i+3])<<8)) / (1<<15 - 1) } r.srcBlock = nextPos r.srcBufL[r.srcBlock] = sl r.srcBufR[r.srcBlock] = sr // To keep srcBufL/R not too big, let's remove the least used buffers. if len(r.lruSrcBlocks) >= 4 { p := r.lruSrcBlocks[0] delete(r.srcBufL, p) delete(r.srcBufR, p) copy(r.lruSrcBlocks, r.lruSrcBlocks[1:]) r.lruSrcBlocks = r.lruSrcBlocks[:len(r.lruSrcBlocks)-1] } r.lruSrcBlocks = append(r.lruSrcBlocks, r.srcBlock) } else { r.srcBlock = nextPos idx := -1 for i, p := range r.lruSrcBlocks { if p == r.srcBlock { idx = i break } } if idx == -1 { panic("not reach") } r.lruSrcBlocks = append(r.lruSrcBlocks[:idx], r.lruSrcBlocks[idx+1:]...) r.lruSrcBlocks = append(r.lruSrcBlocks, r.srcBlock) } ii := i % resamplingBufferSize return r.srcBufL[r.srcBlock][ii], r.srcBufR[r.srcBlock][ii], nil } func (r *Resampling) at(t int64) (float64, float64, error) { windowSize := 8.0 tInSrc := float64(t) * float64(r.from) / float64(r.to) startN := int64(tInSrc - windowSize) if startN < 0 { startN = 0 } if r.size/4 <= startN { startN = r.size/4 - 1 } endN := int64(tInSrc + windowSize) if r.size/4 <= endN { endN = r.size/4 - 1 } lv := 0.0 rv := 0.0 for n := startN; n <= endN; n++ { srcL, srcR, err := r.src(n) if err != nil { return 0, 0, err } d := tInSrc - float64(n) w := 0.5 + 0.5*fastCos01(d/(windowSize*2+1)) s := sinc01(d/2) * w lv += srcL * s rv += srcR * s } if lv < -1 { lv = -1 } if lv > 1 { lv = 1 } if rv < -1 { rv = -1 } if rv > 1 { rv = 1 } return lv, rv, nil } func (r *Resampling) Read(b []byte) (int, error) { if r.pos == r.Length() { return 0, io.EOF } n := len(b) / 4 * 4 if r.Length()-r.pos <= int64(n) { n = int(r.Length() - r.pos) } for i := 0; i < n/4; i++ { l, r, err := r.at(r.pos/4 + int64(i)) if err != nil { return 0, err } l16 := int16(l * (1<<15 - 1)) r16 := int16(r * (1<<15 - 1)) b[4*i] = byte(l16) b[4*i+1] = byte(l16 >> 8) b[4*i+2] = byte(r16) b[4*i+3] = byte(r16 >> 8) } r.pos += int64(n) return n, nil } func (r *Resampling) Seek(offset int64, whence int) (int64, error) { switch whence { case io.SeekStart: r.pos = offset case io.SeekCurrent: r.pos += offset case io.SeekEnd: r.pos += r.Length() + offset } if r.pos < 0 { r.pos = 0 } if r.Length() <= r.pos { r.pos = r.Length() } return r.pos, nil }