diff --git a/src/main.zig b/src/main.zig index bc6e4cf..434f09e 100644 --- a/src/main.zig +++ b/src/main.zig @@ -180,10 +180,15 @@ pub const RotInt = struct { self.pollcount = (self.pollcount + 1) % self.command_freq; if (self.pollcount == 0) { - const mangled: AzEl = .{ + var mangled: AzEl = .{ .az = self.requested_posture.az + self.offsets.az, .el = self.requested_posture.el + self.offsets.el, }; + mangled.el = if (mangled.el > 90) + @min(mangled.el, 180 - self.conf.elevation_mask) + else + @max(mangled.el, self.conf.elevation_mask); + self.sendRotatorCommand(.{ .set_position = mangled }); } else { self.sendRotatorCommand(.get_position);