stack-chan

import Timer from 'timer'
import { speeches } from 'speeches_cheerup'
import { randomBetween } from 'stackchan-util'
import WebSocket from 'WebSocket'

const keys = Object.keys(speeches)

async function sayHooray(robot) {
  const key = keys[Math.floor(randomBetween(0, keys.length))]
  await robot.say(key)
}

function onRobotCreated(robot) {
  let pose
  let hooray = false
  let connected = false
  const rotation = {
    y: 0,
    p: 0,
    r: 0,
  }
  const ws = new WebSocket('ws://192.168.7.112:8080')
  ws.addEventListener('open', () => {
    trace('connected\n')
    robot.setTorque(true)
    connected = true
  })
  ws.addEventListener('message', (event) => {
    trace('received\n')
    pose = JSON.parse(event.data)
  })
  ws.addEventListener('close', () => {
    trace('disconnected\n')
    robot.setTorque(false)
    connected = false
  })

  Timer.repeat(async () => {
    if (pose == null || !connected) {
      return
    }

    // simple low pass filter
    rotation.y = rotation.y * 0.5 + pose.yaw * 0.5
    rotation.p = rotation.p * 0.5 + pose.pitch * 0.5
    robot.setPose(
      {
        rotation,
      },
      0.1
    )

    // emotion
    robot.setEmotion(pose.emotion)

    // hooray on rising edge
    if (!hooray && pose.hooray) {
      await sayHooray(robot)
    }
    hooray = pose.hooray
  }, 200)
}

export default {
  onRobotCreated,
}