# MIT Motor Controller Code Analyze

{% embed url="<https://github.com/bgkatz/motorcontrol>" %}

## Clock Tree

<figure><img src="/files/O8pEg7TNSIK7zNlqzyDx" alt=""><figcaption></figcaption></figure>

## NVIC Settings

<figure><img src="/files/kcI6hBNStljNNHw6Ex4e" alt=""><figcaption></figcaption></figure>

NVIC priority is configured in the code

```c
HAL_NVIC_SetPriority(PWM_ISR, 0x0,0x0); // commutation > communication
HAL_NVIC_SetPriority(CAN_ISR, 0x01, 0x01);
```

## PowerStage PWM Generation

<figure><img src="/files/yRkLQUYXs9rYN9VFSLuV" alt=""><figcaption></figcaption></figure>

Using DIV/1 prescaler, 0x8CA (2250) period, and center aligned mode -> PWM frequency is 80kHz

With the repetition counter set to 1, the software interrupt frequency is 40kHz.

<figure><img src="/files/mh1UW74luOXTFGlwi3q1" alt=""><figcaption></figcaption></figure>

It handles the motor phase inversion at the last stage, before issuing value to TIM.

## Current Sampling

<figure><img src="/files/ajZVedRI73f5tETP3IgC" alt=""><figcaption></figcaption></figure>

It's using 2 phase current shunt, and using blocking ADC call to sample current.

## Encoder

<figure><img src="/files/jBw58YBL17TldDkQHOls" alt=""><figcaption></figcaption></figure>

It's using blocking encoder read/write.

Using this line to fence off too-fast CS pin control:

```c
HAL_GPIO_WritePin(ENC_CS, GPIO_PIN_RESET ); 	// CS low
HAL_SPI_TransmitReceive(&ENC_SPI, (uint8_t*)encoder->spi_tx_buff, (uint8_t *)encoder->spi_rx_buff, 1, 100);
while( ENC_SPI.State == HAL_SPI_STATE_BUSY );  					// wait for transmission complete
HAL_GPIO_WritePin(ENC_CS, GPIO_PIN_SET ); 	// CS high
```

This shouldn't be necessary when using blocking SPI transaction mode...

## The Commutation Loop

```c
void TIM1_UP_TIM10_IRQHandler(void)
{
  /* USER CODE BEGIN TIM1_UP_TIM10_IRQn 0 */
	//HAL_GPIO_WritePin(LED, GPIO_PIN_SET );	// Useful for timing

	/* Sample ADCs */
	analog_sample(&controller);

	/* Sample position sensor */
	ps_sample(&comm_encoder, DT);

	/* Run Finite State Machine */
	run_fsm(&state);

	/* Check for CAN messages */
	can_tx_rx();

	/* increment loop count */
	controller.loop_count++;
	//HAL_GPIO_WritePin(LED, GPIO_PIN_RESET );

  /* USER CODE END TIM1_UP_TIM10_IRQn 0 */
  HAL_TIM_IRQHandler(&htim1);
  /* USER CODE BEGIN TIM1_UP_TIM10_IRQn 1 */
  /* USER CODE END TIM1_UP_TIM10_IRQn 1 */
}
```


---

# Agent Instructions: Querying This Documentation

If you need additional information that is not directly available in this page, you can query the documentation dynamically by asking a question.

Perform an HTTP GET request on the current page URL with the `ask` query parameter:

```
GET https://tk233.gitbook.io/notes/motor-control/mit-motor-controller-code-analyze.md?ask=<question>
```

The question should be specific, self-contained, and written in natural language.
The response will contain a direct answer to the question and relevant excerpts and sources from the documentation.

Use this mechanism when the answer is not explicitly present in the current page, you need clarification or additional context, or you want to retrieve related documentation sections.