Motor.c 5.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("AutoChips Software") are
  4. * protected under relevant copyright laws. The information contained herein is
  5. * confidential and proprietary to AutoChips Inc. and/or its licensors. Without
  6. * the prior written permission of AutoChips inc. and/or its licensors, any
  7. * reproduction, modification, use or disclosure of AutoChips Software, and
  8. * information contained herein, in whole or in part, shall be strictly
  9. * prohibited.
  10. *
  11. * AutoChips Inc. (C) 2016. All rights reserved.
  12. *
  13. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  14. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("AUTOCHIPS SOFTWARE")
  15. * RECEIVED FROM AUTOCHIPS AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER
  16. * ON AN "AS-IS" BASIS ONLY. AUTOCHIPS EXPRESSLY DISCLAIMS ANY AND ALL
  17. * WARRANTIES, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED
  18. * WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR
  19. * NONINFRINGEMENT. NEITHER DOES AUTOCHIPS PROVIDE ANY WARRANTY WHATSOEVER WITH
  20. * RESPECT TO THE SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY,
  21. * INCORPORATED IN, OR SUPPLIED WITH THE AUTOCHIPS SOFTWARE, AND RECEIVER AGREES
  22. * TO LOOK ONLY TO SUCH THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO.
  23. * RECEIVER EXPRESSLY ACKNOWLEDGES THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO
  24. * OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES CONTAINED IN AUTOCHIPS
  25. * SOFTWARE. AUTOCHIPS SHALL ALSO NOT BE RESPONSIBLE FOR ANY AUTOCHIPS SOFTWARE
  26. * RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  27. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND AUTOCHIPS'S
  28. * ENTIRE AND CUMULATIVE LIABILITY WITH RESPECT TO THE AUTOCHIPS SOFTWARE
  29. * RELEASED HEREUNDER WILL BE, AT AUTOCHIPS'S OPTION, TO REVISE OR REPLACE THE
  30. * AUTOCHIPS SOFTWARE AT ISSUE, OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE
  31. * CHARGE PAID BY RECEIVER TO AUTOCHIPS FOR SUCH AUTOCHIPS SOFTWARE AT ISSUE.
  32. */
  33. /**********<Incldue>**********/
  34. #include "ac780x_gpio.h"
  35. #include "ac780x.h"
  36. #include "ac780x_timer.h"
  37. #include "ac780x_pwm.h"
  38. #include "Motor.h"
  39. /**********<Prototype>*********/
  40. /**********<Variable>*********/
  41. uint32_t g_positvePulse;///<pulse width positive value
  42. uint32_t g_negativePulse;///<pulse width negative value
  43. uint32_t g_freq;///<pulse width period value
  44. float g_duty;///<pulse duty value
  45. uint32_t g_hallStatus;///<hall status value
  46. uint32_t g_overFlowCount;//PWM1计数溢出中断
  47. /**
  48. * PWM1_CallBack
  49. *
  50. * @param[in] device: device pointer
  51. * @param[in] wpara: callback parameter
  52. * @param[in] lpara: callback parameter
  53. * @return none
  54. * @brief PWM CallBack
  55. */
  56. void PWM1_CallBack(void *device, uint32_t wpara, uint32_t lpara)
  57. {
  58. //PWM计数器溢出中断
  59. if (wpara & PWM_INIT_CNTOF_Msk)
  60. {
  61. g_overFlowCount ++;
  62. //user add
  63. }
  64. //PWM通道中断
  65. //通过判断回调返回的lpara对应PWM_STR_CHnSF_Msk位状态判断是否发生通道中断
  66. if (lpara & PWM_STR_CHSF_Msk)
  67. {
  68. //user add
  69. //通道0中断
  70. if (lpara & PWM_STR_CH0SF_Msk)
  71. {
  72. }
  73. //通道1中断
  74. if (lpara & PWM_STR_CH1SF_Msk)
  75. {
  76. }
  77. }
  78. }
  79. /**
  80. *
  81. * @param[in] none
  82. *
  83. * @return none
  84. *
  85. * @brief Motor_Init
  86. *
  87. */
  88. void Motor_Init(void)
  89. {
  90. PWM_ConfigType pwmConfig;
  91. PWM_ModulationConfigType initModeStruct;
  92. PWM_IndependentChConfig independentChConfig[2];
  93. memset(&pwmConfig, 0, sizeof(pwmConfig));
  94. memset(&initModeStruct, 0, sizeof(initModeStruct));
  95. //MSP_PWM_Init(PWM1);
  96. /* independent channel 2 configuration */
  97. independentChConfig[0].channel = PWM_CH_2;
  98. independentChConfig[0].chValue = 0;
  99. independentChConfig[0].levelMode = PWM_HIGH_TRUE;
  100. independentChConfig[0].polarity = PWM_OUTPUT_POLARITY_ACTIVE_HIGH;
  101. independentChConfig[0].interruptEn = DISABLE;
  102. independentChConfig[0].initLevel = PWM_LOW_LEVEL;
  103. independentChConfig[0].triggerEn = DISABLE;
  104. /* independent channel 3 configuration */
  105. independentChConfig[1].channel = PWM_CH_3;
  106. independentChConfig[1].chValue = 0; //MOD_PWM>>1;
  107. independentChConfig[1].levelMode = PWM_HIGH_TRUE;
  108. independentChConfig[1].polarity = PWM_OUTPUT_POLARITY_ACTIVE_HIGH;
  109. independentChConfig[1].interruptEn = DISABLE;
  110. independentChConfig[1].initLevel = PWM_LOW_LEVEL;
  111. independentChConfig[1].triggerEn = DISABLE;
  112. initModeStruct.countMode = PWM_UP_COUNT;
  113. initModeStruct.deadtime = 24;
  114. initModeStruct.deadtimePsc = PWM_DEADTIME_DIVID_1;
  115. initModeStruct.initChOutputEn = ENABLE;
  116. initModeStruct.initTriggerEn = DISABLE;
  117. initModeStruct.independentChannelNum = 2;
  118. initModeStruct.independentChConfig = independentChConfig;
  119. pwmConfig.mode = PWM_MODE_MODULATION;
  120. pwmConfig.clkSource = PWM_CLK_SOURCE_APB;
  121. pwmConfig.clkPsc = PWM_PRES;
  122. pwmConfig.initValue = 0;
  123. pwmConfig.maxValue = MOD_PWM - 1;
  124. pwmConfig.overflowInterrupEn = ENABLE;
  125. pwmConfig.cntOverflowFreq = 0;
  126. pwmConfig.interruptEn = DISABLE;
  127. pwmConfig.callBack = PWM1_CallBack; //PWM中断回调
  128. pwmConfig.initModeStruct = &initModeStruct;
  129. PWM_Init(PWM1, &pwmConfig);
  130. NVIC_SetPriority(PWM1_IRQn, 0); //设置PWM模块中断的优先级
  131. }
  132. void Motor_Positive(uint8_t speed)
  133. {
  134. uint16_t chValue=0;
  135. if(speed > 100) speed = 100;
  136. chValue = (uint16_t)speed*MOD_PWM/100;
  137. //printf("Motor_Positive, speed:%d \r\n", speed);
  138. PWM_SetChannelCountValue(PWM1, PWM_CH_3, 0);
  139. PWM_SetChannelCountValue(PWM1, PWM_CH_2, chValue);
  140. }
  141. void Motor_Negative(uint8_t speed)
  142. {
  143. uint16_t chValue=0;
  144. if(speed > 100) speed = 100;
  145. chValue = (uint16_t)speed*MOD_PWM/100;
  146. //printf("Motor_Negative, speed:%d \r\n", speed);
  147. PWM_SetChannelCountValue(PWM1, PWM_CH_2, 0);
  148. PWM_SetChannelCountValue(PWM1, PWM_CH_3, chValue);
  149. }
  150. //电机停止转动
  151. void Motor_Stop(void)
  152. {
  153. PWM_SetChannelCountValue(PWM1, PWM_CH_2, 0);
  154. PWM_SetChannelCountValue(PWM1, PWM_CH_3, 0);
  155. }
  156. /**********<End>*********/