"""Deterministic SIFT suboperation reference, not a complete SIFT extractor.
No image pyramid, subpixel fitting, trilinear histogram voting or geometric fit.
"""
import argparse
import json
import math

# region: extrema
def is_extremum(center, neighbors):
    """Eight same-scale neighbors, nine above and nine below."""
    if len(neighbors)!=26:
        raise ValueError('Expected 26 neighbors')
    return all(center>v for v in neighbors) or all(center<v for v in neighbors)
# endregion: extrema

# region: edge
def edge_score(dxx,dyy,dxy):
    determinant=dxx*dyy-dxy*dxy
    return math.inf if determinant<=0 else (dxx+dyy)**2/determinant


def edge_accepted(dxx,dyy,dxy,r=10):
    return edge_score(dxx,dyy,dxy)<(r+1)**2/r
# endregion: edge

# region: descriptor
def normalize_descriptor(values,clip=0.2):
    """L2 normalize, clip components, then L2 normalize again; not RootSIFT."""
    norm=math.sqrt(sum(v*v for v in values))
    if norm==0:
        return [0.0]*len(values)
    clipped=[min(v/norm,clip) for v in values]
    norm=math.sqrt(sum(v*v for v in clipped))
    return [v/norm for v in clipped]


def orientation_bin(angle,reference=0,bins=8):
    return ((angle-reference)%360)/360*bins
# endregion: descriptor

# region: matching
def ratio_accepted(first,second,threshold=0.8):
    """Unsquared Euclidean distances. Reject an undefined second distance."""
    return first>=0 and second>0 and first/second<threshold
# endregion: matching


def main():
    raw=[20 if i==0 else 2 if i%9==0 else 0.5 for i in range(128)]
    normalized=normalize_descriptor(raw)
    assert math.isclose(sum(x*x for x in normalized),1)
    assert is_extremum(2,[1]*26) and not is_extremum(1,[1]*26)
    assert not edge_accepted(100,1,0) and edge_accepted(2,2,0)
    assert orientation_bin(370,10)==0
    report={'extremum':is_extremum(2,[1]*26),'edgeScore':edge_score(10,1,0),
            'descriptor':normalized,'ratio':ratio_accepted(0.6,1)}
    parser=argparse.ArgumentParser();parser.add_argument('--json',action='store_true');args=parser.parse_args()
    print(json.dumps(report) if args.json else 'SIFT suboperation self-checks passed. '+str(report))

if __name__ == '__main__':
    main()
