Packet handler.h

From HotDec

Pseudo-Code Description

vision_data_handler() {

  Parse packet data into an x,y,theta component
  Record x,y,theta data into a pose vector
  Call set_camera_pos() from enqueue_wrapper.h

}

vision_normal() {

  Call vision_data_handler()
  Adjust K matrix

}

control_data_handler() {

  Parse control packet
  Record pose that accompanied control action
  
  Switch on control command
     SET_PT:
        Call push_to() from enqueue_wrapper.h
     /* Other Functions we don't use much */
     ON_L:
        Call lift_and_thrust_on() from enqueue_wrapper.h
     OFF_L:
        Call lift_and_thrust_off() from enqueue_wrapper.h

}

initialize_handler_array() {

  Assign handlers for control and vision packets

}