You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
 
 
 

90 line
2.2 KiB

  1. #ifndef PLSR_PLANNER_H
  2. #define PLSR_PLANNER_H
  3. #include "plsr_platform.h"
  4. #include <stdint.h>
  5. typedef enum
  6. {
  7. PLSR_BOUNDARY_STOP = 0,
  8. PLSR_BOUNDARY_NEXT_FRESH,
  9. PLSR_BOUNDARY_NEXT_CARRY,
  10. PLSR_BOUNDARY_WAIT_TIME,
  11. PLSR_BOUNDARY_WAIT_SIGNAL,
  12. PLSR_BOUNDARY_WAIT_EXT,
  13. PLSR_BOUNDARY_JUMP,
  14. PLSR_BOUNDARY_EXT_CUT
  15. } PLSR_BOUNDARY_ACTION;
  16. /* A block is self-contained: the planner must not read live Modbus state. */
  17. typedef struct
  18. {
  19. uint32_t entryHz;
  20. uint32_t cruiseHz;
  21. uint32_t exitHz;
  22. uint32_t pulseBudget;
  23. uint32_t referenceSpeedHz;
  24. uint16_t accelerationTimeMs;
  25. uint16_t decelerationTimeMs;
  26. uint16_t curveMode;
  27. uint8_t pulseOutput;
  28. PLSR_BOUNDARY_ACTION boundary;
  29. } PLSR_MOTION_BLOCK;
  30. typedef struct
  31. {
  32. PLSR_PLATFORM_TIMER_SETTING setting;
  33. uint32_t repeatCount;
  34. } PLSR_STREAM_ITEM;
  35. typedef enum
  36. {
  37. PLSR_PLANNER_OK = 0,
  38. PLSR_PLANNER_CLIPPED,
  39. PLSR_PLANNER_DONE,
  40. PLSR_PLANNER_INVALID
  41. } PLSR_PLANNER_STATUS;
  42. typedef struct
  43. {
  44. PLSR_MOTION_BLOCK block;
  45. uint64_t phasePulses;
  46. uint32_t startHz;
  47. uint32_t peakHz;
  48. uint32_t endHz;
  49. uint32_t entryPulses;
  50. uint32_t steadyPulses;
  51. uint32_t exitPulses;
  52. uint32_t generatedPulses;
  53. uint32_t rampRelativePulse;
  54. uint32_t rampPulseCount;
  55. uint32_t rampFromHz;
  56. uint32_t rampToHz;
  57. uint32_t rampDurationMs;
  58. uint32_t lastRampHz;
  59. uint64_t rampTotalAreaQ32;
  60. uint64_t rampAreaStepQ32;
  61. uint64_t rampTargetAreaQ32;
  62. uint64_t rampBoundaryQ32;
  63. uint64_t rampActualTimeQ32;
  64. uint64_t rampLastPhaseStepQ32;
  65. uint64_t rampFirstBoundaryQ32;
  66. uint64_t rampSecondBoundaryQ32;
  67. uint32_t rampAreaRemainder;
  68. uint32_t rampRemainderAccumulator;
  69. uint8_t rampKind;
  70. uint8_t clipped;
  71. uint8_t active;
  72. } PLSR_PLANNER_CONTEXT;
  73. PLSR_PLANNER_STATUS PlsrPlannerBegin(PLSR_PLANNER_CONTEXT *context,
  74. const PLSR_MOTION_BLOCK *block,
  75. uint32_t appliedHz,
  76. uint64_t phasePulses);
  77. uint16_t PlsrPlannerGenerate(PLSR_PLANNER_CONTEXT *context,
  78. PLSR_STREAM_ITEM *output,
  79. uint16_t capacity);
  80. #endif /* PLSR_PLANNER_H */