app_dummy.c 1.7 KB

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