import copy

import numpy as np
import pytest

from pallet.pose_dimension_report import pair_geometry,stats
from pallet.pose_review_geometry import basis_for


def record(key,normal,center,width,frame='same'):
    sensor=dict(scale_to_m=.001,forward_axis=0,forward_sign=1,up_axis=2,up_sign=1)
    return dict(target_key=key,source=dict(frame_id=frame),sensor=sensor,polygon=[[0,0],[10,0],[10,10],[0,10]],
        ruler=dict(origin=center,basis=basis_for(normal,sensor).tolist(),w=0,d=0,angle=0,half_width=width/2))


def test_group_balanced_median_limits_adjacent_frame_dominance():
    rs=[dict(group_id='large',width_m=1.) for _ in range(100)]+[dict(group_id='small',width_m=1.2),dict(group_id='other',width_m=1.4)]
    s=stats(rs);assert s['median_m']==1. and s['group_balanced_median_m']==1.2
    assert s['n']==102 and s['groups']==3


def test_no_data_does_not_invent_dimension():
    s=stats([]);assert s['median_m'] is None and s['group_balanced_median_m'] is None


def test_two_faces_keep_unequal_physical_widths_and_no_second_millimetre_scale():
    a=record('a',[1,0,0],[0,0,0],1.0);b=record('b',[0,1,0],[.6,-.5,0],1.2)
    p=pair_geometry(a,b)
    assert p['candidate_pass'] and p['normal_acute_angle_deg']==pytest.approx(90)
    assert p['nearest_endpoint_workplane_gap_m']==pytest.approx(0)
    assert a['ruler']['half_width']*2==1. and b['ruler']['half_width']*2==1.2


def test_nearby_parallel_faces_not_adjacent_pair():
    a=record('a',[1,0,0],[0,0,0],1.);b=record('b',[1,0,0],[0,.1,0],1.2)
    assert not pair_geometry(a,b)['candidate_pass']


def test_different_frames_and_incompatible_axes_never_combined():
    a=record('a',[1,0,0],[0,0,0],1.);b=record('b',[0,1,0],[.6,-.5,0],1.2,frame='other')
    assert pair_geometry(a,b) is None
    b['source']['frame_id']='same';b['sensor']['scale_to_m']=1.
    assert pair_geometry(a,b) is None


def test_different_stack_layers_fail_geometric_screen():
    a=record('a',[1,0,0],[0,0,0],1.);b=record('b',[0,1,0],[.6,-.5,.3],1.2)
    assert not pair_geometry(a,b)['candidate_pass']


def test_projection_same_height_required_for_pairs():
    a=record('a',[1,0,0],[0,0,0],1.);b=record('b',[0,1,0],[.6,-.5,0],1.2)
    b['polygon']=[[0,20],[10,20],[10,30],[0,30]]
    assert not pair_geometry(a,b)['candidate_pass']
