+1

Ứng dụng tìm góc trong không gian bằng python

Chắc hẳn ai cũng được học phân tích vecto trên ghế nhà trường, hiện tại mình cũng đang làm về 1 dự án về phân tích tư thế của cơ thể khi tập vật lý trị liệu, thế nên được áp dụng những công thức từ trước để tìm góc được tạo bởi 3 điểm : vai, hông, đầu gối. Có những không gian 2D, 3D nhưng hôm nay mình sẽ áp dụng với dữ liệu 2D.

Công thức tính góc có thể xác định theo đại số hoặc hình học. ĐỊnh nghĩa hình học dựa trên các khái niệm về góc và khoảng cách( độ lớn của vector). Sự tương đương của hai định nghĩa này phụ thuộc vào việc có một hệ tọa độ Decartes cho không gian Euclide.

1. Định nghĩa hình học:

1 góc gồm độ lớn và hướng. Một vector có thể được hình dung như 1 mũi tên. Độ lớn của nó là chiều dài và hướng của nó là hướng mà mũi tên chỉ tới. Độ lớn của 1 vector a được kí hiệu là ||a||. Tích số chấm của 2 vector Oclit a và b được xác định bởi θ là góc giữa a và b .

Giải thích:

2. Công thức

Sử dụng thư viện math:

import math
 
def getAngle(knee, hip, shoulder):
    ang = math.degrees(math.atan2(shoulder[1]-hip[1], shoulder[0]-hip[0]) - math.atan2(knee[1]-hip[1], knee[0]-hip[0]))
    return ang + 360 if ang < 0 else ang
 
print(getAngle((5, 0), (0, 0), (0, 5)))

Sử dụng thư viện numpy

def get_degree_three_points(p, p1, p2):
    v1 = np.array([p1.x - p.x, p1.y - p.y])
    v2 = np.array([p2.x - p.x, p2.y - p.y])
    unit_v1 = v1 / np.linalg.norm(v1)
    unit_v2 = v2 / np.linalg.norm(v2)
    dot_product = np.dot(unit_v1, unit_v2)
    angle = np.math.atan2(np.linalg.det([unit_v1, unit_v2]), dot_product)
    degree = np.round(np.degrees(angle), 2)
    return degree if degree > 0 else degree + 360

Ngoài ra, từ công thức trên cũng có thể tạo góc với 2 điểm , điểm còn lại chỉnh là trục OX VD: độ nghiêng của thân người (gồm vai và hông)

import math
 
def get_Angle(hip, shoulder):
    ang = math.degrees(math.atan2(shoulder[1]-hip[1], shoulder[0]-hip[0]))
    return ang + 360 if ang < 0 else ang
 
print(get_Angle((0, 0), (0,5)))

Hoặc có trường hợp sẽ tính góc của hông trái- vai trái sẽ khác với hông phải - lưng phải , thì sẽ là 1 hệ quy chiếu khác đối nghịch trục ox với không gian trước, ta sẽ tính với công thức sau

import math
 
def get_Angle_negative(hip, shoulder):
    ang = math.degrees(math.atan2(shoulder[1]-hip[1], shoulder[0]-hip[0])- math.atan2(0,-1))
    return ang + 360 if ang < 0 else ang
 
print(get_Angle_negative((0, 0), (0,5)))

Nguồn : https://manivannan-ai.medium.com/find-the-angle-between-three-points-from-2d-using-python-348c513e2cd


All rights reserved

Viblo
Hãy đăng ký một tài khoản Viblo để nhận được nhiều bài viết thú vị hơn.
Đăng kí