fixed commutation pattern
This commit is contained in:
		
							parent
							
								
									9be08d33f1
								
							
						
					
					
						commit
						a12432df36
					
				| 
						 | 
					@ -335,9 +335,9 @@ uint8_t readHallSensorM1(void)
 | 
				
			||||||
	volatile uint8_t b = gpio_get_pin_level(M1_HALL_B_PIN);
 | 
						volatile uint8_t b = gpio_get_pin_level(M1_HALL_B_PIN);
 | 
				
			||||||
	volatile uint8_t c = gpio_get_pin_level(M1_HALL_C_PIN);
 | 
						volatile uint8_t c = gpio_get_pin_level(M1_HALL_C_PIN);
 | 
				
			||||||
	
 | 
						
 | 
				
			||||||
	return ((c << 2)	|
 | 
						return ((a << 2)	|
 | 
				
			||||||
			(b << 1)	|
 | 
								(b << 1)	|
 | 
				
			||||||
			(a << 0));
 | 
								(c << 0));
 | 
				
			||||||
	
 | 
						
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
| 
						 | 
					@ -347,7 +347,7 @@ uint8_t readHallSensorM2(void)
 | 
				
			||||||
	volatile uint8_t b = gpio_get_pin_level(M2_HALL_B_PIN);
 | 
						volatile uint8_t b = gpio_get_pin_level(M2_HALL_B_PIN);
 | 
				
			||||||
	volatile uint8_t c = gpio_get_pin_level(M2_HALL_C_PIN);
 | 
						volatile uint8_t c = gpio_get_pin_level(M2_HALL_C_PIN);
 | 
				
			||||||
	
 | 
						
 | 
				
			||||||
	return ((c << 2)	|
 | 
						return ((a << 2)	|
 | 
				
			||||||
			(b << 1)	|
 | 
								(b << 1)	|
 | 
				
			||||||
			(a << 0));
 | 
								(c << 0));
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
| 
						 | 
					@ -72,24 +72,24 @@
 | 
				
			||||||
*/
 | 
					*/
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/* CCW from Back - works best in forward diraction*/
 | 
					/* CCW from Back - works best in forward diraction*/
 | 
				
			||||||
static const uint16_t COMMUTATION_PATTERN[] = {
 | 
					//static const uint16_t COMMUTATION_PATTERN[] = {
 | 
				
			||||||
	0x003F,		// (0) invalid state
 | 
						//0x003F,		// (0) invalid state
 | 
				
			||||||
	0x053D,		// (1)
 | 
						//0x053D,		// (1)
 | 
				
			||||||
	0x1437,		// (2)
 | 
						//0x1437,		// (2)
 | 
				
			||||||
	0x113D,		// (3)
 | 
						//0x113D,		// (3)
 | 
				
			||||||
	0x111F,		// (4)
 | 
						//0x111F,		// (4)
 | 
				
			||||||
	0x141F,		// (5)
 | 
						//0x141F,		// (5)
 | 
				
			||||||
	0x0537,		// (6)
 | 
						//0x0537,		// (6)
 | 
				
			||||||
	0x003F,		// (7) invalid state
 | 
						//0x003F,		// (7) invalid state
 | 
				
			||||||
	0x003F,		// (8) invalid state
 | 
						//0x003F,		// (8) invalid state
 | 
				
			||||||
	0x0537,		// (9)
 | 
						//0x0537,		// (9)
 | 
				
			||||||
	0x141F,		// (10)
 | 
						//0x141F,		// (10)
 | 
				
			||||||
	0x111F,		// (11)
 | 
						//0x111F,		// (11)
 | 
				
			||||||
	0x113D,		// (12)
 | 
						//0x113D,		// (12)
 | 
				
			||||||
	0x1437,		// (13)
 | 
						//0x1437,		// (13)
 | 
				
			||||||
	0x053D,		// (14)
 | 
						//0x053D,		// (14)
 | 
				
			||||||
	0x003F		// (15) invalid state
 | 
						//0x003F		// (15) invalid state
 | 
				
			||||||
};
 | 
					//};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
////* CW From Back */
 | 
					////* CW From Back */
 | 
				
			||||||
//static const uint16_t COMMUTATION_PATTERN[16] = {
 | 
					//static const uint16_t COMMUTATION_PATTERN[16] = {
 | 
				
			||||||
| 
						 | 
					@ -131,6 +131,26 @@ static const uint16_t COMMUTATION_PATTERN[] = {
 | 
				
			||||||
	//0x003F		// (15) invalid state
 | 
						//0x003F		// (15) invalid state
 | 
				
			||||||
//};
 | 
					//};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					////* A&C phase swapped */
 | 
				
			||||||
 | 
					static const uint16_t COMMUTATION_PATTERN[16] = {
 | 
				
			||||||
 | 
						0x003F,		// (0) invalid state
 | 
				
			||||||
 | 
						0x1437,		// (1)
 | 
				
			||||||
 | 
						0x053D,		// (2)
 | 
				
			||||||
 | 
						0x113D,		// (3)
 | 
				
			||||||
 | 
						0x111F,		// (4)
 | 
				
			||||||
 | 
						0x0537,		// (5)
 | 
				
			||||||
 | 
						0x141F,		// (6)
 | 
				
			||||||
 | 
						0x003F,		// (7) invalid state
 | 
				
			||||||
 | 
						0x003F,		// (8) invalid state
 | 
				
			||||||
 | 
						0x141F,		// (9)
 | 
				
			||||||
 | 
						0x0537,		// (10)
 | 
				
			||||||
 | 
						0x111F,		// (11)
 | 
				
			||||||
 | 
						0x113D,		// (12)
 | 
				
			||||||
 | 
						0x053D,		// (13)
 | 
				
			||||||
 | 
						0x1437,		// (14)
 | 
				
			||||||
 | 
						0x003F		// (15) invalid state
 | 
				
			||||||
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
typedef struct
 | 
					typedef struct
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
| 
						 | 
					@ -156,7 +176,6 @@ typedef struct
 | 
				
			||||||
	const float32_t motor_MeasureRange_RPM;	// give 20% headroom
 | 
						const float32_t motor_MeasureRange_RPM;	// give 20% headroom
 | 
				
			||||||
	const float32_t motor_Max_Spd_ELEC;
 | 
						const float32_t motor_Max_Spd_ELEC;
 | 
				
			||||||
	const float32_t motor_Max_Current_IDC_A;
 | 
						const float32_t motor_Max_Current_IDC_A;
 | 
				
			||||||
	const Hall_pins_t hallPins;
 | 
					 | 
				
			||||||
} BLDCMotor_param_t;
 | 
					} BLDCMotor_param_t;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
//static BLDCMotor_param_t FH_22mm24BXTR;
 | 
					//static BLDCMotor_param_t FH_22mm24BXTR;
 | 
				
			||||||
| 
						 | 
					@ -176,8 +195,6 @@ const static BLDCMotor_param_t FH_22mm24BXTR = {
 | 
				
			||||||
	.motor_MeasureRange_RPM	 = 3000 * 1.2,	//(1.2f * MOTOR_MAX_SPD_RPM)f   // give 20% headroom
 | 
						.motor_MeasureRange_RPM	 = 3000 * 1.2,	//(1.2f * MOTOR_MAX_SPD_RPM)f   // give 20% headroom
 | 
				
			||||||
	.motor_Max_Spd_ELEC		 = (3000/60)*7.0,		//(MOTOR_MAX_SPD_RPM/60)*MOTOR_POLEPAIRS
 | 
						.motor_Max_Spd_ELEC		 = (3000/60)*7.0,		//(MOTOR_MAX_SPD_RPM/60)*MOTOR_POLEPAIRS
 | 
				
			||||||
	.motor_Max_Current_IDC_A = 0.368,
 | 
						.motor_Max_Current_IDC_A = 0.368,
 | 
				
			||||||
	.hallPins				 = {M1_HALL_A_PIN, M1_HALL_B_PIN, M1_HALL_C_PIN}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
};
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/* Big Motor - 3216W024BXTR */
 | 
					/* Big Motor - 3216W024BXTR */
 | 
				
			||||||
| 
						 | 
					
 | 
				
			||||||
		Loading…
	
		Reference in New Issue