app_dummy.c 1.6 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697
  1. #include "app_dummy.h"
  2. #include <stdint.h>
  3. nBusAppInterface_t dummy_driver = {
  4. dummy_init,
  5. dummy_reset,
  6. dummy_getType,
  7. dummy_getSensorCount,
  8. dummy_getData,
  9. dummy_setData,
  10. dummy_hasParam,
  11. dummy_getParam,
  12. dummy_setParam,
  13. dummy_start,
  14. dummy_stop,
  15. dummy_read,
  16. };
  17. nBusAppInterface_t *getDummyDriver(){
  18. return &dummy_driver;
  19. }
  20. void dummy_init(void *hw_interface, void *hw_config){
  21. }
  22. void dummy_reset(){
  23. }
  24. nBus_sensorType_t dummy_getType(uint8_t sensor_index){
  25. if (sensor_index > dummy_getSensorCount())
  26. return TYPE_UNKNOWN;
  27. switch (sensor_index){
  28. case 1:
  29. return TYPE_ACCELEROMETER;
  30. case 2:
  31. return TYPE_GYROSCOPE;
  32. case 3:
  33. return TYPE_MAGNETOMETER;
  34. case 4:
  35. return TYPE_HEART_RATE;
  36. case 5:
  37. return TYPE_PRESSURE;
  38. }
  39. return TYPE_UNKNOWN;
  40. }
  41. uint8_t dummy_getSensorCount(){
  42. return 4;
  43. }
  44. uint32_t dummy_data[4]={0x12345678, 0x9ABCDEF0, 0x87654321, 0x0FEDCBA9};
  45. uint8_t dummy_getData(uint8_t sensor_index, uint8_t *data){
  46. for (uint8_t i=0; i<4 ;++i){
  47. data[i] = ((uint8_t*)&dummy_data)[i+(sensor_index-1)*8];
  48. data[4+i] = ((uint8_t*)&dummy_data)[4+i+(sensor_index-1)*8];
  49. }
  50. return 8;
  51. }
  52. uint8_t dummy_setData(uint8_t *data){
  53. return 1;
  54. }
  55. uint8_t dummy_getParam(uint8_t sensor_index, nBus_param_t param){
  56. return 0xAB;
  57. }
  58. uint8_t dummy_hasParam(uint8_t sensor_index, nBus_param_t param){
  59. if (sensor_index < dummy_getSensorCount())
  60. return 1;
  61. return 0;
  62. }
  63. nBus_param_t dummy_setParam(uint8_t sensor_index, nBus_param_t param, uint8_t value){
  64. return param;
  65. }
  66. void dummy_start(void){
  67. return;
  68. }
  69. void dummy_stop(void){
  70. return;
  71. }
  72. void dummy_read(void){
  73. return;
  74. }