const { NearestScanner } = require('@toio/scanner')

async function main() {
  // start a scanner to find nearest cube
  const cube = await new NearestScanner().start()
  // connect to the cube
  await cube.connect()

  let sumLeft = 0
  let sumRight = 0
  let moveState = 0
  let moveDelayTimer

  cube.on('motor:speed-feedback', (data) => {
    console.log(data)
    if (data.left === 0 && data.right === 0) {
      if (moveState === 0) {
        if (sumLeft + sumRight > 20) {
          moveState = 1
          moveDelayTimer = setTimeout(()=> {
            const power = (sumLeft + sumRight) / 20
            const curve = (sumRight - sumLeft) / 2
            moveState = 2
            console.log('move', power, curve)
            cube.playPresetSound(1)
            cube.turnOnLight({durationMs: 2550, red: 255, blue: 0, green: 0}, 1)
            cube.moveWithAcc(-power, curve, 0, 0)
            setTimeout(() => {
              console.log('stopping')
              cube.moveWithAcc(0, 0, 20, 0)
            }, power * 10)
          }, 500)
        }
      }else if(moveState === 2){
        cube.turnOffLight()
        cube.playPresetSound(2)
        console.log('stopped')
        moveState = 0
        sumLeft = 0
        sumRight = 0
      }
    }else{
      if(moveState === 0){
        sumLeft += data.left
        sumRight += data.right
      }else if (moveState === 1){
        moveState = 0
        clearTimeout(moveDelayTimer)
      }
    }
  })

  cube.setMotorFeedbackEnable(1).then((result) => {
    console.log(result)
  })
}

main()