1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
|
#!/usr/bin/env python
from dataclasses import dataclass, field
from argaze import DataStructures
import cv2 as cv
import matplotlib.path as mpath
import numpy
@dataclass
class AreaOfInterest(numpy.ndarray):
"""Define 2D/3D Area Of Interest."""
def dimension(self):
"""Number of coordinates coding area points positions."""
return self.shape[1]
def center(self):
"""Center of mass"""
return self.mean(axis=0)
def clockwise(self):
"""Get area points in clocwise order."""
if self.dimension() != 2:
raise RuntimeError(f'Bad area dimension ({self.dimension()})')
O = self.center()
OP = (self - O) / numpy.linalg.norm(self - O)
angles = numpy.arctan2(OP[:, 1], OP[:, 0])
return self[numpy.argsort(angles)]
def looked(self, gaze_position):
"""Is gaze position inside area ?"""
if self.dimension() != 2:
raise RuntimeError(f'Bad area dimension ({self.dimension()})')
return mpath.Path(self).contains_points([(gaze_position.x, gaze_position.y)])[0]
def look_at(self, gaze_position):
"""Get where the area is looked."""
if self.dimension() != 2:
raise RuntimeError(f'Bad area dimension ({self.dimension()})')
P = numpy.array([gaze_position.x, gaze_position.y])
clockwise_area = self.clockwise()
O = clockwise_area[0]
OX, OY = clockwise_area[1] - O, clockwise_area[-1] - O
OP = P - O
return numpy.array([numpy.dot(OP, OX) / numpy.dot(OX, OX), numpy.dot(OP, OY) / numpy.dot(OY, OY)])
def draw(self, frame, color):
# Draw form
cv.line(frame, self[-1], self[0], color, 1)
for A, B in zip(self, self[1:]):
cv.line(frame, A, B, color, 1)
# Draw center
cv.circle(frame, self.center().astype(int), 1, color, -1)
@dataclass
class AOIScene():
"""Define 2D/3D AOI scene."""
dimension: int = field(init=False, default=None)
"""Dimension of the AOIs in scene."""
areas: dict = field(init=False, default_factory=dict)
"""All aois in the scene."""
def append(self, name, aoi: AreaOfInterest):
"""Add an aoi to the scene."""
self.areas[name] = aoi
class TimeStampedAOIScenes(DataStructures.TimeStampedBuffer):
"""Define timestamped buffer to store AOI scenes in time."""
def __setitem__(self, key, value):
"""Force value to inherit from AOIScene."""
if type(value).__bases__[0] != AOIScene:
raise ValueError(f'value must inherit from AOIScene')
super().__setitem__(key, value)
|