【旋转角度(CW/CCW)的累加计算】

1,需求
旋转角度(CW/CCW)的累加计算

2,代码实现

class AngleProcess:
    def __init__(self, is_cw, period=360):
        self.is_cw = is_cw
        self.period = period
        self.half_period = period / 2

        self.init_angle_0_and_circle_num()

    def check_if_add_one_rotation(self, is_cw, pre_angle, cur_angle, half_period=180):
        """如果是 cw :pre_angle 到 360, cur_angle 到 0。如何表达这个?意思是下降了 180+
        如果是 ccw :pre_angle 到 0, cur_angle 到 360。如何表达这个?意思是上升了 180+"""
        if is_cw:
            if pre_angle - cur_angle > half_period:
                is_add_one_rotation = True
            else:
                is_add_one_rotation = False
        else:
            if cur_angle - pre_angle > half_period:
                is_add_one_rotation = True
            else:
                is_add_one_rotation = False
        return is_add_one_rotation

    def init_angle_0_and_circle_num(self):
        self.angle_0 = None
        self.circle_num = 0

    def get_angle_cumulatived(self, cur_angle, pre_angle=None):
        my_angle = None
        if self.angle_0 is None:
            self.angle_0 = cur_angle
        if pre_angle is not None:
            is_add_one_rotation = self.check_if_add_one_rotation(self.is_cw, pre_angle, cur_angle)
            if is_add_one_rotation:
                self.circle_num += 1
                print(f"self.circle_num: {self.circle_num}")

        if self.is_cw:
            my_angle = (cur_angle - self.angle_0) + self.period * self.circle_num
        else:
            my_angle = (self.angle_0 - cur_angle) + self.period * self.circle_num

        return my_angle


def main():
    is_cw = False
    xx = list(range(360, 1, -10)) + list(range(360, 1, -10)) + list(range(360, 1, -10))
    # is_cw = True
    # xx = list(range(1, 360, 10)) + list(range(1, 360, 10)) + list(range(1, 360, 10))

    ap_obj = AngleProcess(is_cw=is_cw, period=360)
    ap_obj.init_angle_0_and_circle_num()
    pre_angle = None
    # ap_obj.set_angle_0(cur_angle)
    my_angle_list = list()

    for cur_angle in xx:
        # print(f"cur_angle-{cur_angle}")
        my_angle = ap_obj.get_angle_cumulatived(cur_angle=cur_angle, pre_angle=pre_angle)
        my_angle_list.append(my_angle)
        pre_angle = cur_angle

    import matplotlib.pyplot as plt
    plt.plot(my_angle_list)
    plt.show()


if __name__ == '__main__':
    main()

3,结果
CW/CCW都是从0开始累加,图形一致。这个对CW/CCW画到一张图有好处

CW/CCW都是从0开始累加

  • 8
    点赞
  • 10
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值