PIInit.c 1.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768
  1. /********************************************************************************
  2. **** Copyright (C), 2020, Fortior Technology Co., Ltd. ****
  3. ********************************************************************************
  4. * File Name : PIInit.c
  5. * Author : Bruce HW&RD
  6. * Date : 2020-10-16
  7. * Description : .C file function description
  8. * Version : 1.0
  9. * Function List :
  10. *
  11. * Record :
  12. * 1.Date : 2020-10-16
  13. * Author : Bruce HW&RD
  14. * Modification: Created file
  15. ********************************************************************************/
  16. /* Includes -------------------------------------------------------------------*/
  17. #include "PIInit.h"
  18. #include "FU68xx_5.h"
  19. #include "Customer.h"
  20. #include "Parameter.h"
  21. #include "AddFunction.h"
  22. #include "FiledWeaken.h"
  23. void PI_Init(void)
  24. {
  25. PI0_KP = SKP;
  26. PI0_KI = SKI;
  27. PI0_EK = 0;
  28. PI0_EK1 = 0;
  29. PI0_UKMAX = SOUTMAX;
  30. PI0_UKMIN = SOUTMIN;
  31. PI0_UKH = 0;
  32. PI0_UKL = 0;
  33. PI1_KP = FiledWeakenKp;
  34. PI1_KI = FiledWeakenKi;
  35. PI1_EK = 0;
  36. PI1_EK1 = 0;
  37. PI1_UKMAX = 0;//mcFieldWeakenPID.outMax;
  38. PI1_UKMIN = _Q15((float)-35.0 / 180.0) ;// mcFieldWeakenPID.outMin;
  39. PI1_UKH = 0;
  40. PI1_UKL = 0;
  41. }
  42. void PI2_Init(void)
  43. {
  44. PI2_KP = fengSKP;
  45. PI2_KI = fengSKI;
  46. PI2_KD=0;
  47. PI2_EK = 0;
  48. PI2_EK1 = 0;
  49. PI2_EK2 =0 ;
  50. PI2_UKMAX = 1000;
  51. PI2_UKMIN = 1;
  52. PI2_UKH = 0;
  53. PI2_UKL = 0;
  54. }
  55. int16 PI_realize(int16 speed)
  56. {
  57. PI0_EK = speed;
  58. SMDU_RunBlock(0 , 7); //调用MDU运算单元0中的PI模式(7)
  59. return PI0_UKH;
  60. }