package com.ard.tianyu.component.netty.command.manual;

import com.ard.tianyu.domain.dto.manual.FlyPointControlDTO;
import com.ard.tianyu.component.netty.command.BaseCmd;
import io.netty.buffer.ByteBuf;

/**
 * 指点飞行控制指令
 *
 * @author liusuyi
 * @date 2024年10月26日15:43
 **/
public class FlyPointControlCmd extends BaseCmd {
    private final double longitude;                  // 经度
    private final double latitude;                   // 纬度
    private final float altitude;                    // 高度
    private final float speed;                       // 速度
    private final byte flyMode;                      // 飞行模式

    public FlyPointControlCmd(FlyPointControlDTO flyPointControlDTO) {
        setDataHeader((short) 0x7479);
        setDataLength((short) 43);
        setBoxSn(flyPointControlDTO.getBoxSn().getBytes());
        setCmdCode((byte) 0xD1);
        this.longitude = flyPointControlDTO.getLongitude();
        this.latitude = flyPointControlDTO.getLatitude();
        this.altitude = flyPointControlDTO.getAltitude();
        this.speed = flyPointControlDTO.getSpeed();
        this.flyMode = flyPointControlDTO.getFlyMode();
    }


    public void encode(ByteBuf out) {
        out.writeShort(getDataHeader());    // 写入数据头
        out.writeShort(getDataLength());    // 写入数据长度
        out.writeBytes(getBoxSn());         // 写入盒子SN
        out.writeByte(getCmdCode());        // 写入命令码
        out.writeByte(0x00);          // 写入加密标志
        out.writeByte(0x39);          // 写入动作编号
        out.writeDouble(longitude);         // 写入经度
        out.writeDouble(latitude);          // 写入纬度
        out.writeFloat(altitude);           // 写入高度
        out.writeFloat(speed);              // 写入速度
        out.writeByte(flyMode);             // 写入飞行模式
    }
}