Skip to content

GitLab

A
atkbldcdriver
Commit 31155db3 authored by Jake Read's avatar Jake Read
Browse files
Options

v031 commutating closed loop, ready for network

parent bc5a946a
Hide whitespace changes
Inline Side-by-side
Showing with 349 additions and 83 deletions
circuit/mkbldcdriver/eagle.epf
View file @ 31155db3
......@@ -36,11 +36,11 @@ UsedLibrary="D:/Dropbox (Personal)/CBA/doc/libraries_jake/eagle/sparkfun/SparkFu
[Win_1]
Type="Schematic Editor"
Loc="0 0 1919 1016"
Loc="-1928 -8 -9 1008"
State=1
Number=2
File="mkbldcdriver.sch"
View="-133.101 -16.4054 69.9278 60.3757"
View="-191.238 -0.355913 101.124 110.209"
WireWidths=" 0.0762 0.1016 0.127 0.15 0.2 0.2032 0.254 0.3048 0.4064 0.508 0.6096 0.8128 1.016 1.27 2.54 0.1524"
PadDiameters=" 0.254 0.3048 0.4064 0.6096 0.8128 1.016 1.27 1.4224 1.6764 1.778 1.9304 2.1844 2.54 3.81 6.4516 0"
PadDrills=" 0.2 0.25 0.3 0.35 0.4 0.45 0.5 0.55 0.65 0.7 0.75 0.8 0.85 0.9 1 0.6"
......@@ -79,7 +79,7 @@ ArcDirection=0
AddLevel=2
PadsSameType=0
Layer=91
Views=" 1: -133.101 -16.4054 69.9278 60.3757"
Views=" 1: -191.238 -0.355913 101.124 110.209"
Sheet="1"
[Win_2]
......@@ -88,7 +88,7 @@ Loc="0 0 1919 1016"
State=1
Number=1
File="mkbldcdriver.brd"
View="13.5716 56.9498 32.0603 57.5241"
View="21.1469 45.1135 67.1527 46.5425"
WireWidths=" 0.0762 0.1016 0.127 0.15 0.508 0.6096 0.8128 2.54 1.016 1.27 0.3048 0.254 0.2 0.4064 0.2032 0.1524"
PadDiameters=" 0.254 0.3048 0.4064 0.6096 0.8128 1.016 1.27 1.4224 1.6764 1.778 1.9304 2.1844 2.54 3.81 6.4516 0"
PadDrills=" 0.2 0.25 0.35 0.4 0.45 0.5 0.55 0.65 0.7 0.75 0.8 0.85 0.9 1 0.6 0.3"
......
circuit/mkbldcdriver/mkbldcdriver.brd
View file @ 31155db3
......@@ -173,8 +173,8 @@
<text x="35.052" y="20.193" size="0.6096" layer="21" font="vector">V-W</text>
<text x="35.052" y="22.86" size="0.6096" layer="21" font="vector">V-V</text>
<text x="35.052" y="25.273" size="0.6096" layer="21" font="vector">V-U</text>
<text x="35.052" y="30.48" size="0.6096" layer="21" font="vector">C-V</text>
<text x="35.052" y="27.813" size="0.6096" layer="21" font="vector">C-W</text>
<text x="35.052" y="30.48" size="0.6096" layer="21" font="vector">I-V</text>
<text x="35.052" y="27.813" size="0.6096" layer="21" font="vector">I-W</text>
<text x="35.052" y="33.02" size="0.6096" layer="21" font="vector">3V3</text>
<text x="35.052" y="35.56" size="0.6096" layer="21" font="vector">GND</text>
<text x="35.052" y="37.973" size="0.6096" layer="21" font="vector">LO3</text>
......
embedded/README.md
View file @ 31155db3
......@@ -517,3 +517,42 @@ OK!
Properly, I should do this on a timer. I'm going to do it in the while() loop for now, just to check that I'm having the output on the PWMs that I want.
Great - I have this running in the open while() loop. It commutates! I suppose I shouldn't be surprised at this stuff anymore.
I set up my logic analyzer so that I can start on this commutation debug cycle. I have three pins on the lo-sides of the PWMs, three on the voltage sense pinse, and two on the current sense pins.
I'm hearing this 'tick' every so often as the motor commutates. Here's what it looks like on the analyzer:
![pwm-tick](https://gitlab.cba.mit.edu/jakeread/mkbldcdriver/raw/master/images/programming-pwm-ticking.png)
So I think that one of the PWM registers is occasionally being written to 100% in error. My suspicion is that this has something to do with my fast-and-loose commutation scheme, which I'm about to improve.
While I did notice that this was only occuring while the motor driver's gates where enabled (so, 'stuff was happening'), I tried using the ATSAMD's PWM Capture-Compare Buffer (capture-compare is the value the pwm timer checks to switch-or-not-switch the output). The buffer let's me write into the PWM registers when I'm sure they're not being read by the peripheral. This eliminated the problem. I also pushed the PWM frequency to 22kHZ and it's all silky smooth sounding now.
OK, some current / voltage waveforms:
Channels: Fault, PWM Hi U, Pwm Hi V, Pwm Hi W, Current V, Current W, Voltage V, Voltage W.
![currents](https://gitlab.cba.mit.edu/jakeread/mkbldcdriver/raw/master/images/programming-currents-olcommutate-1.png)
![currents](https://gitlab.cba.mit.edu/jakeread/mkbldcdriver/raw/master/images/programming-currents-olcommutate-2.png)
I set this up to accept a commanded 'torque' (just PWM duty cycle) and direction, so next step here is doing some network integration as well.
![clvideo](https://gitlab.cba.mit.edu/jakeread/mkbldcdriver/raw/video/20khz-commutate.mp4)
Then, a longer list of development:
# Next:
## Firmware
- Closed-Loop Speed Control (maybe using simple 6-step commutation?)
- Search for Encoder Offset
- Closed-Loop Position Control
- Probably just Sinusoid PWM Commutation
- The Big Bite: FOC
## Hardware
- I have a list of incremental improvements... mostly:
- Go to 2oz copper so that I dont' blow up any traces when the power hits
- Discrete LEDs and more indication (there's an overcurrent / overtemp warning I want to break out)
\ No newline at end of file
embedded/mkbldcdriver-v03/mkbldcdriver-v03/Debug/Makefile
View file @ 31155db3
......@@ -38,8 +38,10 @@ SUBDIRS := \
# Add inputs and outputs from these tool invocations to the build variables
C_SRCS += \
../bldc_pfoc.c \
../Device_Startup/startup_samd51.c \
../Device_Startup/system_samd51.c \
../encoder.c \
../main.c \
../pin.c \
../pwm_foc.c \
......@@ -55,8 +57,10 @@ ASM_SRCS +=
OBJS += \
bldc_pfoc.o \
Device_Startup/startup_samd51.o \
Device_Startup/system_samd51.o \
encoder.o \
main.o \
pin.o \
pwm_foc.o \
......@@ -65,8 +69,10 @@ spiport.o \
uartport.o
OBJS_AS_ARGS += \
bldc_pfoc.o \
Device_Startup/startup_samd51.o \
Device_Startup/system_samd51.o \
encoder.o \
main.o \
pin.o \
pwm_foc.o \
......@@ -75,8 +81,10 @@ spiport.o \
uartport.o
C_DEPS += \
bldc_pfoc.d \
Device_Startup/startup_samd51.d \
Device_Startup/system_samd51.d \
encoder.d \
main.d \
pin.d \
pwm_foc.d \
......@@ -85,8 +93,10 @@ spiport.d \
uartport.d
C_DEPS_AS_ARGS += \
bldc_pfoc.d \
Device_Startup/startup_samd51.d \
Device_Startup/system_samd51.d \
encoder.d \
main.d \
pin.d \
pwm_foc.d \
......@@ -127,14 +137,18 @@ LINKER_SCRIPT_DEP+= \
Device_Startup/%.o: ../Device_Startup/%.c
./%.o: .././%.c
@echo Building file: $<
@echo Invoking: ARM/GNU C Compiler : 6.3.1
$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\arm\arm-gnu-toolchain\bin\arm-none-eabi-gcc.exe$(QUOTE) -x c -mthumb -D__SAMD51J18A__ -DDEBUG -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\arm\CMSIS\5.0.1\CMSIS\Include" -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\SAMD51_DFP\1.0.70\include" -O1 -ffunction-sections -mlong-calls -g3 -Wall -mcpu=cortex-m4 -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)" -o "$@" "$<"
@echo Finished building: $<
./%.o: .././%.c
Device_Startup/%.o: ../Device_Startup/%.c
@echo Building file: $<
@echo Invoking: ARM/GNU C Compiler : 6.3.1
$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\arm\arm-gnu-toolchain\bin\arm-none-eabi-gcc.exe$(QUOTE) -x c -mthumb -D__SAMD51J18A__ -DDEBUG -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\arm\CMSIS\5.0.1\CMSIS\Include" -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\atmel\SAMD51_DFP\1.0.70\include" -O1 -ffunction-sections -mlong-calls -g3 -Wall -mcpu=cortex-m4 -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)" -o "$@" "$<"
......
embedded/mkbldcdriver-v03/mkbldcdriver-v03/Debug/makedep.mk
View file @ 31155db3
......@@ -2,10 +2,14 @@
# Automatically-generated file. Do not edit or delete the file
################################################################################
bldc_pfoc.c
Device_Startup\startup_samd51.c
Device_Startup\system_samd51.c
encoder.c
main.c
pin.c
......
embedded/mkbldcdriver-v03/mkbldcdriver-v03/bldc_pfoc.c 0 → 100644
View file @ 31155db3
/*
* bldc_pfoc.c
*
* Created: 2/19/2018 10:40:54 AM
* Author: Jake
*/
#include "bldc_pfoc.h"
#include "encoder.h"
#include "sinelut.h"
#include "pwm_foc.h"
#include "hardware.h"
void bldc_init(bldc_t *bldc, uint32_t resolution, uint32_t modulo, uint32_t offset, uint32_t reverse){
bldc->resolution = resolution;
bldc->modulo = modulo;
bldc->offset = offset;
bldc->reverse = reverse;
bldc->modmap = modulo / 1024;
}
// super simple throttle
void bldc_command(bldc_t *bldc, uint32_t scalar, uint32_t dir){
if(scalar > BLDC_MAX_SCALAR){
bldc->scalar = BLDC_MAX_SCALAR;
} else {
bldc->scalar = scalar;
}
bldc->dir = dir;
}
void bldc_update(bldc_t *bldc){
// read encoder, where 0 - 2^14 is 0 - 2*PI rads mechanical phase
encoder_read(&bldc->reading);
// reverse the reading if that flag is set
if(bldc->reverse){
bldc->reading = bldc->resolution - bldc->reading;
}
// electric position and offsetting
// one modulo is one full electric phase, is some division of full rotations
// so, elecpos is 0 - modulo (uint) describing 0 - 2*PI rads of an electric phase
bldc->elecpos = (bldc->reading + bldc->offset) % bldc->modulo;
// now we map the phases from 0 - modulo (uint) -> 0 - 1024 (uint)
// this is the depth of our lookup table for sin()
// we computed this value at init, as modulo / lut_depth;
// we compute the modpos once
bldc->modpos = bldc->elecpos / bldc->modmap;
if(bldc->dir){
bldc->phaseu = bldc->modpos;
bldc->phasev = bldc->modpos + 341; // + 120* in lut phase
bldc->phasew = bldc->modpos + 682; // + 240*
} else {
bldc->phaseu = bldc->modpos + 682;
bldc->phasev = bldc->modpos + 341; // + 120* in lut phase
bldc->phasew = bldc->modpos; // + 240*
}
// now we check for wrap arounds in the lut phase
(bldc->phaseu > 1023) ? (bldc->phaseu -= 1023) : (0);
(bldc->phasev > 1023) ? (bldc->phasev -= 1023) : (0);
(bldc->phasew > 1023) ? (bldc->phasew -= 1023) : (0);
// and set the pwm value to be the sin of it's current electric phase,
// where the sinelut returns a value 0 - 255
// midpoint (0 volts, equal time on / off) being 128
// and multiply that value by a scalar
bldc->pwmu = (sinelut[bldc->phaseu] * bldc->scalar) / 255;
bldc->pwmv = sinelut[bldc->phasev] * bldc->scalar / 255;
bldc->pwmw = sinelut[bldc->phasew] * bldc->scalar / 255;
// finally, sending new pwm values
// we assert the minimum value to be 5 and the max to be 250
// this leaves some time for deadtime insertion (set with TCC_WEXCTRL_DTHS(1) in PWM setup)
pwmupdate_foc(bldc->pwmu,bldc->pwmv,bldc->pwmw);
}
\ No newline at end of file
embedded/mkbldcdriver-v03/mkbldcdriver-v03/bldc_pfoc.h 0 → 100644
View file @ 31155db3
/*
* bldc_pfoc.h
*
* Created: 2/19/2018 10:40:36 AM
* Author: Jake
*/
#ifndef BLDC_PFOC_H_
#define BLDC_PFOC_H_
#include "sam.h"
#define BLDC_MAX_SCALAR 255
#define BLDC_INIT_OFFSET 700
#define BLDC_RESOLUTION 16834
#define BLDC_MODULO 2340
#define BLDC_REVERSE 1
// struct to wrap commutation information
typedef struct{
uint32_t resolution;
uint32_t modulo;
uint32_t offset;
uint32_t reverse;
uint32_t modmap;
uint32_t scalar;
uint32_t dir;
uint32_t reading;
uint32_t elecpos;
uint32_t modpos;
uint32_t phaseu, pwmu;
uint32_t phasev, pwmv;
uint32_t phasew, pwmw;
}bldc_t;
void bldc_init(bldc_t *bldc, uint32_t resolution, uint32_t modulo, uint32_t offset, uint32_t reverse);
void bldc_command(bldc_t *bldc, uint32_t scalar, uint32_t dir);
void bldc_update(bldc_t *bldc);
#endif /* BLDC_PFOC_H_ */
\ No newline at end of file
embedded/mkbldcdriver-v03/mkbldcdriver-v03/encoder.c 0 → 100644
View file @ 31155db3
/*
* encoder.c
*
* Created: 2/19/2018 11:11:57 AM
* Author: Jake
*/
#include "encoder.h"
#include "hardware.h"
void encoder_read(uint32_t *data_return){
uint8_t data_tx[2] = {0xFF, 0xFF}; // read command: 1s, noop: 0s
uint8_t data_rx[2];
spi_txrxchars_polled(&spi_encoder, data_tx, 2, data_rx);
data_tx[0] = 0x00;
data_tx[1] = 0x00;
spi_txrxchars_polled(&spi_encoder, data_tx, 2, data_rx);
* data_return = (data_rx[0] & 0b00111111) << 8 | data_rx[1];
}
\ No newline at end of file
embedded/mkbldcdriver-v03/mkbldcdriver-v03/encoder.h 0 → 100644
View file @ 31155db3
/*
* encoder.h
*
* Created: 2/19/2018 11:11:23 AM
* Author: Jake
*/
#ifndef ENCODER_H_
#define ENCODER_H_
#include "sam.h"
void encoder_read(uint32_t *data_return);
#endif /* ENCODER_H_ */
\ No newline at end of file
embedded/mkbldcdriver-v03/mkbldcdriver-v03/hardware.h
View file @ 31155db3
......@@ -13,6 +13,8 @@
#include "ringbuffer.h"
#include "uartport.h"
#include "spiport.h"
#include "bldc_pfoc.h"
#include "pwm_foc.h"
pin_t stlb;
......@@ -33,4 +35,8 @@ pin_t m_gain;
pin_t fault;
pin_t octw;
bldc_t bldc;
pin_t testp;
#endif /* HARDWARE_H_ */
\ No newline at end of file
embedded/mkbldcdriver-v03/mkbldcdriver-v03/main.c
View file @ 31155db3
......@@ -7,27 +7,42 @@
#include "sam.h"
#include "pwm_foc.h"
#include "pin.h"
#include "ringbuffer.h"
#include "uartport.h"
#include "spiport.h"
#include "hardware.h"
#include "sinelut.h"
#include "encoder.h"
#include <stdio.h>
// stlb is PA23
uint32_t encoder_read(void){
uint8_t data_tx[2] = {0xFF, 0xFF}; // read command: 1s, noop: 0s
uint8_t data_rx[2];
spi_txrxchars_polled(&spi_encoder, data_tx, 2, data_rx);
data_tx[0] = 0x00;
data_tx[1] = 0x00;
spi_txrxchars_polled(&spi_encoder, data_tx, 2, data_rx);
uint32_t data = (data_rx[0] & 0b00111111) << 8 | data_rx[1];
return data;
void comticker_init(uint32_t cc){
// Timers: in 32 bit mode we pair two - obscure datasheet reading later, they pair in a predefined way: 0 with 1...
// a word of warning: with the same code, a 16-bit timer was not working. I am mystified.
TC2->COUNT32.CTRLA.bit.ENABLE = 0;
TC3->COUNT32.CTRLA.bit.ENABLE = 0;
// unmask clocks
MCLK->APBBMASK.reg |= MCLK_APBBMASK_TC2 | MCLK_APBBMASK_TC3; // at 15.8.9
// generate a gclk
GCLK->GENCTRL[11].reg = GCLK_GENCTRL_SRC(GCLK_GENCTRL_SRC_DFLL) | GCLK_GENCTRL_GENEN;
while(GCLK->SYNCBUSY.reg & GCLK_SYNCBUSY_GENCTRL(11));
// ship gclk to their channels
GCLK->PCHCTRL[TC2_GCLK_ID].reg = GCLK_PCHCTRL_CHEN | GCLK_PCHCTRL_GEN(11);
GCLK->PCHCTRL[TC3_GCLK_ID].reg = GCLK_PCHCTRL_CHEN | GCLK_PCHCTRL_GEN(11);
// turn on in mode, presync
TC2->COUNT32.CTRLA.reg = TC_CTRLA_MODE_COUNT32 | TC_CTRLA_PRESCSYNC_PRESC | TC_CTRLA_PRESCALER_DIV16 | TC_CTRLA_CAPTEN0;// | TC_CTRLA_CAPTEN1;
TC3->COUNT32.CTRLA.reg = TC_CTRLA_MODE_COUNT32 | TC_CTRLA_PRESCSYNC_PRESC | TC_CTRLA_PRESCALER_DIV16 | TC_CTRLA_CAPTEN0;// | TC_CTRLA_CAPTEN1;
// do frequency match
TC2->COUNT32.WAVE.reg = TC_WAVE_WAVEGEN_MFRQ;
TC3->COUNT32.WAVE.reg = TC_WAVE_WAVEGEN_MFRQ;
// allow interrupt to trigger on this event (compare channel 0)
TC2->COUNT32.INTENSET.bit.MC0 = 1;
TC2->COUNT32.INTENSET.bit.MC1 = 1; // don't know why, but had to turn this on to get the interrupts
// set period
while(TC2->COUNT32.SYNCBUSY.bit.CC0);
TC2->COUNT32.CC[0].reg = 165;
while(TC2->COUNT32.SYNCBUSY.bit.CC1);
TC2->COUNT32.CC[1].reg = 165;
// enable, sync for enable write
TC2->COUNT32.CTRLA.bit.ENABLE = 1;
while(TC2->COUNT32.SYNCBUSY.bit.ENABLE);
TC3->COUNT32.CTRLA.bit.ENABLE = 1;
while(TC3->COUNT32.SYNCBUSY.bit.ENABLE);
}
int main(void)
......@@ -46,6 +61,7 @@ int main(void)
NVIC_EnableIRQ(SERCOM4_2_IRQn); //up1rx
NVIC_EnableIRQ(SERCOM5_0_IRQn);
NVIC_EnableIRQ(SERCOM5_2_IRQn);
NVIC_EnableIRQ(TC2_IRQn);
// Rinbuffers for UARTs
rb_init(&up1_rbrx);
......@@ -103,11 +119,10 @@ int main(void)
// OCTW PA22: input, open drain when active, use pullup
fault = pin_new(&PORT->Group[0], 21);
pin_input(&fault);
pin_pullup(&fault);
octw = pin_new(&PORT->Group[0], 22);
pin_input(&octw);
// do closed loop sinucommutate, following old ATSAMS70 code
// do BLDC closed, open loop
pin_pullup(&octw);
// enable or don't
//pin_clear(&en_gate);
......@@ -118,61 +133,31 @@ int main(void)
pin_clear(&m_gain);
pin_clear(&dc_cal);
uint32_t resolution = 16384;
uint32_t modulo = 2340;
uint32_t offset = 800;
uint32_t reverse = 1;
uint32_t scalar = 42; // of 255
bldc_init(&bldc, BLDC_RESOLUTION, BLDC_MODULO, BLDC_INIT_OFFSET, BLDC_REVERSE);
bldc_command(&bldc, 90, 1);
uint32_t reading;
uint32_t elecpos;
uint32_t phaseu, pwmu;
uint32_t phasev, pwmv;
uint32_t phasew, pwmw;
// startup timer for 5khz commutation loop
comticker_init(64);
while (1)
{
// read encoder & get electric position (relative phase period, not rotation period)
reading = encoder_read();
if(reverse){
reading = resolution - reading;
if(!pin_read(&octw)){
pin_clear(&stlb);
}
elecpos = (reading + offset) % modulo;
// not LUT'd yet
phaseu = elecpos / (modulo / 1024);
phasev = elecpos / (modulo / 1024) + 341;
phasew = elecpos / (modulo / 1024) + 682;
(phaseu > 1023) ? (phaseu -= 1023) : (0);
(phasev > 1023) ? (phasev -= 1023) : (0);
(phasew > 1023) ? (phasew -= 1023) : (0);
pwmu = sinelut[phaseu] * scalar / 255 + 1;
pwmv = sinelut[phasev] * scalar / 255 + 1;
pwmw = sinelut[phasew] * scalar / 255 + 1;
pwmupdate_foc(pwmu,pwmv,pwmw);
// timer should be running, doing bldc things
// use these while() loops to handle network
}
}
// ok, we're commutating
/*
- ticking: it's a PWM update error, occasionally setting some values to 100%
- implement a timer to commutate at a set frequency
- work through the mess of values above, go faster, cleaner
- basic search for reverse, offset, modulo etc would be cool, hard (probably)
- verify all gates are opening
*/
uint8_t loopcnt;
void SysTick_Handler(void){
pin_toggle(&stlb);
pin_set(&stlb);
loopcnt ++;
uart_sendchar_buffered(&up1, loopcnt);
uint32_t reading = encoder_read();
uint32_t reading;
//encoder_read(&reading);
reading = bldc.reading;
uint8_t d1 = reading >> 8;
uint8_t d2 = reading;
uart_sendchar_buffered(&up1, d1);
......@@ -194,3 +179,9 @@ void SERCOM5_0_Handler(void){
void SERCOM5_2_Handler(void){
uart_rxhandler(&up2);
}
void TC2_Handler(void){
TC2->COUNT32.INTFLAG.bit.MC0 = 1;
TC2->COUNT32.INTFLAG.bit.MC1 = 1;
bldc_update(&bldc);
}
\ No newline at end of file
embedded/mkbldcdriver-v03/mkbldcdriver-v03/mkbldcdriver-v03.cproj
View file @ 31155db3
......@@ -159,12 +159,24 @@
</ToolchainSettings>
</PropertyGroup>
<ItemGroup>
<Compile Include="bldc_pfoc.c">
<SubType>compile</SubType>
</Compile>
<Compile Include="bldc_pfoc.h">
<SubType>compile</SubType>
</Compile>
<Compile Include="Device_Startup\startup_samd51.c">
<SubType>compile</SubType>
</Compile>
<Compile Include="Device_Startup\system_samd51.c">
<SubType>compile</SubType>
</Compile>
<Compile Include="encoder.c">
<SubType>compile</SubType>
</Compile>
<Compile Include="encoder.h">
<SubType>compile</SubType>
</Compile>
<Compile Include="hardware.h">
<SubType>compile</SubType>
</Compile>
......
embedded/mkbldcdriver-v03/mkbldcdriver-v03/pin.c
View file @ 31155db3
......@@ -11,6 +11,7 @@
pin_t pin_new(PortGroup *port, uint32_t pin_number){
pin_t pin;
pin.port = port;
pin.pin = pin_number;
pin.bm = (uint32_t)(1 << pin_number);
return pin;
}
......@@ -23,6 +24,16 @@ void pin_output(pin_t *pin){
void pin_input(pin_t *pin){
pin->port->DIRCLR.reg = pin->bm;
pin->port->PINCFG[pin->pin].bit.INEN = 1;
}
void pin_pullup(pin_t *pin){
pin->port->PINCFG[pin->pin].bit.PULLEN = 1;
pin->port->OUTSET.reg |= pin->bm;
}
void pin_pulldown(pin_t *pin){
pin->port->PINCFG[pin->pin].bit.PULLEN = 1;
}
void pin_set(pin_t *pin){
......
embedded/mkbldcdriver-v03/mkbldcdriver-v03/pin.h
View file @ 31155db3
......@@ -13,14 +13,20 @@
typedef struct {
PortGroup *port;
uint32_t pin;
uint32_t bm; // bitmask
} pin_t;
pin_t pin_new(PortGroup *port, uint32_t pin);
void pin_output(pin_t *pin);
void pin_input(pin_t *pin);
void pin_pullup(pin_t *pin);
void pin_pulldown(pin_t *pin);
void pin_set(pin_t *pin);
void pin_clear(pin_t *pin);
void pin_toggle(pin_t *pin);
......
embedded/mkbldcdriver-v03/mkbldcdriver-v03/pwm_foc.c
View file @ 31155db3
......@@ -5,6 +5,7 @@
* Author: Jake
*/
#include "pwm_foc.h"
#include "hardware.h"
void pwmsetup_foc(void){
/* TCC SETUP */
......@@ -49,7 +50,7 @@ void pwmsetup_foc(void){
GCLK->PCHCTRL[TCC0_GCLK_ID].reg = GCLK_PCHCTRL_CHEN | GCLK_PCHCTRL_GEN_GCLK5;
TCC0->CTRLA.reg |= TCC_CTRLA_PRESCALER_DIV8 | TCC_CTRLA_PRESCSYNC_PRESC |TCC_CTRLA_RESOLUTION(0);
TCC0->CTRLA.reg |= TCC_CTRLA_PRESCALER_DIV4 | TCC_CTRLA_PRESCSYNC_PRESC |TCC_CTRLA_RESOLUTION(0);
// (2) Select Waveform Generation operation in the WAVE register WAVE.WAVEGEN
// we want dual slope pwm
......@@ -62,14 +63,14 @@ void pwmsetup_foc(void){
TCC_WEXCTRL_DTIEN1 | TCC_WEXCTRL_DTIEN2 | TCC_WEXCTRL_DTIEN3 | TCC_WEXCTRL_DTIEN0 |
TCC_WEXCTRL_OTMX(0);
TCC0->PER.reg = TCC_PER_PER(256); // 18 bit
TCC0->PER.reg = TCC_PER_PER(256);
TCC0->COUNT.reg = 0;
TCC0->CC[0].reg = 0; // '3'
TCC0->CC[1].reg = 0; // '2'
TCC0->CC[2].reg = 0; // '1'
TCC0->CC[3].reg = 0;
TCC0->CCBUF[0].reg = 0; // '3'
TCC0->CCBUF[1].reg = 0; // '2'
TCC0->CCBUF[2].reg = 0; // '1'
TCC0->CCBUF[3].reg = 0;
// (4) Enable with CTRLA.ENABLE
......@@ -77,8 +78,27 @@ void pwmsetup_foc(void){
while(TCC0->SYNCBUSY.bit.ENABLE);
}
#define PWMFOC_MIN_PWM 3
#define PWMFOC_MAX_PWM 253
void pwmupdate_foc(uint32_t one, uint32_t two, uint32_t three){
TCC0->CC[0].reg = three; // '3'
TCC0->CC[1].reg = two; // '2'
TCC0->CC[2].reg = one; // '1'
pwm_bounds(&three);
pwm_bounds(&two);
pwm_bounds(&one);
/*
uart_sendchar_buffered(&up1, one);
uart_sendchar_buffered(&up1, two);
uart_sendchar_buffered(&up1, three);
*/
TCC0->CCBUF[0].reg = three; // '3'
TCC0->CCBUF[1].reg = two; // '2'
TCC0->CCBUF[2].reg = one; // '1'
}
void pwm_bounds(uint32_t *val){
if(*val > PWMFOC_MAX_PWM){
*val = PWMFOC_MAX_PWM;
} else if(*val < PWMFOC_MIN_PWM){
*val = PWMFOC_MIN_PWM;
}
}
\ No newline at end of file