UdpLaser.h 2.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061
  1. /*************************
  2. sick 511 �״� updЭ�����ӿ��ư�
  3. *************************/
  4. #pragma once
  5. #include "Laser.h"
  6. #include <sys/types.h>
  7. #include <sys/socket.h>
  8. #include <netinet/in.h>
  9. #include <arpa/inet.h>
  10. #include <mutex>
  11. class CUdpLaser : public Laser_base
  12. {
  13. public:
  14. CUdpLaser(int id, Laser_proto::laser_parameter laser_param);
  15. virtual ~CUdpLaser();
  16. //雷达链接设备,为3个线程添加线程执行函数。
  17. virtual Error_manager connect_laser();
  18. //雷达断开链接,释放3个线程
  19. virtual Error_manager disconnect_laser();
  20. //对外的接口函数,负责接受并处理任务单,
  21. //input:p_laser_task 雷达任务单,基类的指针,指向子类的实例,(多态)
  22. //注:这个函数为虚函数,实际的处理任务的代码由子类重载并实现。
  23. virtual Error_manager execute_task(Task_Base* p_laser_task);
  24. //检查雷达状态,是否正常运行
  25. virtual Error_manager check_laser();
  26. //雷达的启动接口函数, 让雷达进行扫描,一般需要子类重载,不同的雷达开始方式不同。
  27. virtual Error_manager start_scan();
  28. //雷达的停止接口函数, 让雷达停止扫描,一般需要子类重载,不同的雷达结束方式不同。
  29. virtual Error_manager stop_scan();
  30. //结束任务单,stop之后,要检查线程状态和数据结果,然后才能 end_task
  31. virtual Error_manager end_task();
  32. protected:
  33. //接受二进制消息的功能函数,每次只接受一个CBinaryData
  34. // 纯虚函数,必须由子类重载,
  35. virtual bool receive_buf_to_queue(Binary_buf& data);
  36. //将二进制消息转化为三维点云的功能函数,每次只转化一个CBinaryData,
  37. // 纯虚函数,必须由子类重载,
  38. virtual Buf_type transform_buf_to_points(Binary_buf* pData, std::vector<CPoint3D>& points);
  39. private:
  40. bool Send(const char* sendbuf, int len); // ����ָ��
  41. int Recv(char* recvbuf, int len); // ��������
  42. static int FindHead(char* buf, int b_len);
  43. static int FindTail(char* buf, int b_len);
  44. private:
  45. bool GetData(Binary_buf* pData, std::vector<float>& distance,
  46. float& freq, float& start_angle);
  47. long Str0x2Long(const char* data, int len);
  48. protected:
  49. #pragma region udp��ر���
  50. int m_socket;
  51. // WSADATA m_wsd;
  52. struct sockaddr_in m_send_addr;
  53. std::mutex m_mutex;
  54. #pragma endregion
  55. };