// Buttplug Rust Source Code File - See https://buttplug.io for more info.
//
// Copyright 2016-2024 Nonpolynomial Labs LLC. All rights reserved.
//
// Licensed under the BSD 3-Clause license. See LICENSE file in the project root
// for full license information.

use std::sync::atomic::{AtomicU8, Ordering};

use uuid::{Uuid, uuid};

use crate::device::{
  hardware::{HardwareCommand, HardwareWriteCmd},
  protocol::{ProtocolHandler, generic_protocol_setup},
};
use buttplug_core::errors::ButtplugDeviceError;
use buttplug_server_device_config::Endpoint;

const JOYHUB_V2_PROTOCOL_UUID: Uuid = uuid!("3144b936-99c8-47f3-b85d-defa5fac9e6d");
generic_protocol_setup!(JoyHubV2, "joyhub-v2");

#[derive(Default)]
pub struct JoyHubV2 {
  last_cmds: [AtomicU8; 3],
}

impl JoyHubV2 {
  fn form_hardware_command(
    &self,
    index: u32,
    speed: u32,
  ) -> Result<Vec<HardwareCommand>, ButtplugDeviceError> {
    info!("GOT JOYHUB COMMAND");
    self.last_cmds[index as usize].store(speed as u8, Ordering::Relaxed);
    Ok(vec![
      HardwareWriteCmd::new(
        &[JOYHUB_V2_PROTOCOL_UUID],
        Endpoint::Tx,
        vec![
          0xa0,
          0x03,
          self.last_cmds[0].load(Ordering::Relaxed),
          self.last_cmds[1].load(Ordering::Relaxed),
          self.last_cmds[2].load(Ordering::Relaxed),
          0x00,
          0xaa,
        ],
        false,
      )
      .into(),
    ])
  }
}

impl ProtocolHandler for JoyHubV2 {
  fn handle_output_vibrate_cmd(
    &self,
    feature_index: u32,
    _feature_id: Uuid,
    speed: u32,
  ) -> Result<Vec<HardwareCommand>, ButtplugDeviceError> {
    self.form_hardware_command(feature_index, speed)
  }

  fn handle_output_rotate_cmd(
    &self,
    feature_index: u32,
    _feature_id: Uuid,
    speed: i32,
  ) -> Result<Vec<HardwareCommand>, ButtplugDeviceError> {
    self.form_hardware_command(feature_index, speed as u32)
  }

  fn handle_output_oscillate_cmd(
    &self,
    feature_index: u32,
    _feature_id: Uuid,
    speed: u32,
  ) -> Result<Vec<HardwareCommand>, ButtplugDeviceError> {
    self.form_hardware_command(feature_index, speed)
  }

  fn handle_output_constrict_cmd(
    &self,
    _feature_index: u32,
    feature_id: Uuid,
    level: u32,
  ) -> Result<Vec<HardwareCommand>, ButtplugDeviceError> {
    Ok(vec![
      HardwareWriteCmd::new(
        &[feature_id],
        Endpoint::Tx,
        vec![0xa0, 0x0d, 0x00, 0x00, level as u8, 0xff],
        false,
      )
      .into(),
    ])
  }
}