python手臂伸直检测

感谢编程玩家的胡老师

	(x1, y1) = p1
    (x2, y2) = p2
    (x3, y3) = p3
    
    # 使用三角函数公式获取3个点p1-p2-p3,以p2为角的角度值,0-180度之间
    angle = int(math.degrees(math.atan2(y1-y2, x1-x2) - math.atan2(y3-y2, x3-x2)))
    #atan2(x,y) 能得出x,y点到原点的弧度值 上面就是理解等同于是x2,y2是原点 分别得出跟原点的对应夹角 减去得到夹角
    #夹角有正负 atan2 返回的时候PI到-PI

    if angle < 0:
        angle = angle + 360 #负角度 理解成在第四象限 -60 顺时针60度 画出来等同于逆时针300度 也就是+360
    if angle > 180:
        angle = 360 - angle #逆时针大于180度后 这里是手臂伸直角度 有效区间就在0-180 所以要360减去angle 也就是用顺时针做夹角

在这里插入图片描述

这里角度的换算 我个人理解是要注意 顺时针跟逆时针角度

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值