F²MC-8L/16LX/FR FAMILY
Contents
1. MCU AN 500067 E 14 Page 6 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU 2 2 Sensorless Drive 2 2 1 Sensorless Startup The suggested startup method is forced startup The following is the driving pattern The marker A and A are the state change while A B is the position detect mask off period used to mask off unwanted interrupt when the back EMF is very weak during startup U gt V U 2W V gt W V U W gt U W V W Falling V Rising U Falling W Rising V Falling U Rising Up Vp Upper arm control E Un Vn Lower arm control 4 MCU AN 500067 E 14 Page 7 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU The normal run consists of 12 different driving patterns and 6 different states The following shows the relationship between the driving patterns and the expected interrupts from the position detection circuit D position detection interrupt enable A next position detection interrupt A B commutation delay B C change arm delay C D change arm mask off period 2 2 2 Normal Run Marker explanation A position detection interrupt B change state C change chopping arm S3b S4a 3a S1b S2a 51 MCU AN 500067 E 14 Page 8 Q 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU 3 HW Description The library is used for MB95F330 and MB95F390 series MCU This library only use2. MCU resources to be ready for start and stop commands Initialize port configuration Initialize multi function timer resources Initialize speed check timer Initialize interrupt Initialize motor state to MOTOR READY em MN Syntax Input parameters extern void Sensor Less Start unsigned short start duty on unsigned short start period unsigned short normal duty on unsigned short normal period Start motor from reset with sensorless drive Motor State will be MOTOR NORMAL or MOTOR_FAILURE Startup and normal run parameters are initialized start duty startup carrier frequency duty on duration in 125ns unit Start period startup carrier period in 125ns period unit Normal duty on carrier duty on duration when startup changes to normal run in 125ns unit normal duty carrier period in normal run mode Sensor Less Start 400 1600 200 800 60us on time during startup 400 x 125ns gt 60000 5kHz carrier frequency gt 1600 x 125ns startup carrier period 25us on time just after startup 200 x 125ns gt 25000 10kHz carrier frequency gt 800 x 125ns normal run carrier MCU AN 500067 E 14 Page 12 c 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU extern void Motor Parm unsigned long speed con Syntax unsigned short csd unsigned short cad unsigned short camaskt unsigned short stmaskt Define runtime parameters with sensorless drive Define speed constant for speed checking u
3. change start_duty_on start duty In order to keep motor can change start state to normal state When we changed start_duty_on we should change normal_duty_on to keep the start duty as same as normal duty Set speed Because of different motors have different numbers of pole pair So we should change this function for counting motor speed Motor_Parm unsigned long speed con unsigned short csd unsigned short cad unsigned short camaskt unsigned short stmaskt We should change speed con according to numbers of pole pair by the follow formula speed con 6000000 2x number of pole pair Improve efficiency Sometimes we find the efficiency is very low We can adjust three parameters of Motor Parm function Motor Parm unsigned long speed con unsigned short csd unsigned short cad unsigned short camaskt unsigned short stmaskt MCU AN 500067 E 14 Page 19 co FUJITSU 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 7 Sample Program Motor zip is a sample project containing source code which can drive a sensorless brushless or hall sensor DC motor with motor EV Board PN MB2146 440 E V1 2 Please refer to Motor EV Board MB2146 440 E HW User Manual Tested configuration DC motor Fulling FL28BL26 15V 8006AF Number of phases 3 Number of poles 4 Supply voltage 15VDC Minimum tested speed 1000rpm Maximum tested speed 7000rpm MCU work load 896 3096 Motor speed from 1000 rpm to 7000 rpm with sensorless d
4. motor cannot be started TRUE 1 the motor can be started Variable extern unsigned char Drive Level Description Drive motor level choice Value Drive High 0 high level drive Drive Low 1 low level drive MCU AN 500067 E 14 Page 15 co FUJITSU 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 6 Usage of Library Functions In general user should follow the following steps to control the motor Set global variables with suitable values Initialize the MCU resource Start the motor with suitable startup speed Modify motor synchronous speed accelerating speed and decelerating speed by changing values of the global variables Stop the motor lt 6 1 Operation Flow 6 1 1 Start Motor This can be done by calling the following successively using appropriate parameters Choice drive level high or low Is Driver Mode SENSOR LESS Is Start Motor TRUE Is Start Motor TRUE Is Motor State MOTOR NORMAL Is Motor State MOTOR NORMAL YES Motor Init Start Motor FALSE Sensor Less Normal Work Motor Set Change Speed Sensor Less Start Motor Init Start Motor FALSE Motor Set Change Speed Hall Sensor Start Hall Sensor Normal Work MCU AN 500067 E 14 Page 16 Q 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU 6 1 2 Change Motor Speed To change motor speed please ensur
5. Fujitsu Semiconductor Shanghai Co Ltd Application Note F 2MC 8FX FAMILY 8 BIT MICROCONTROLLER MB95330 SERIES 120 HALL SENSOR SENSORLESS DC INVERTER CONTROL F2MC 8L 8FX SOFTUNE C LIBRARY APPLICATION NOTE co FUJITSU co FUJITSU 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 Revision History Date Author Change of Records 2009 11 20 Kevin Wang V1 0 First draft 2009 11 30 Kevin Wang V1 1 Modify 2010 01 11 Kevin Wang V1 2 Modify 2010 03 08 Kevin Wang V1 2 Modify 4 1 2010 03 30 Kevin Wang V1 3 Update motor drive waveform and back waveform 2010 12 07 Kevin Wang V1 4 Add HW description Add DTTI c file Add drive level choice function Add get motor speed function Add how to adjust parameter Add more motor fail indicate This manual contains 22 pages MCU AN 500067 E 14 Page 2 Q 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU CONTENTS REVISION HISTORY e 2 1 INTRODUGTION owas cas 4 2 OPERATION PRINCIPLES AND 5 2 1 Hall Sensor DTV Gc 2 sanat tun Sl ga EV ana 5 1916 12219 6 A 7 221 Sensorless StartUp iaaaainsaaan naanannnnnn
6. Parameters are initialized duty_on Carrier frequency duty on duration in Input parameters 125ns unit period Carrier period in 125ns period unit LOOK NENNEN Hall Sensor Start 150 800 18 75us on time during startup 150 x 125ns gt 150 10kHz carrier frequency gt 800 x 125ns startup carrier period extern void Hall Sensor Normal Work void Control motor running normally with hall sensor drive Description Count motor speed Control motor speed Check hall sensor signal and change arm extern unsigned int Motor Get Speed void Syntax Get motor actual speed Input parameters Motor actual speed in RPM MCU AN 500067 E 14 Page 14 Q 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU 5 2 External Variables extern unsigned char Motor_ State Motor operation mode MOTOR_READY 1 motor ready for accepting start command MOTOR_START 2 motor in startup stage Value MOTOR NORMAL 3 motor in normal run stage MOTOR FAILURE 4 motor which cannot run MOTOR START FAILURE 5 motor start failed OVER CURRENT 6 motor over current extern unsigned char Rotation Direction Motor running direction Value ANTICLOCKWISE 0 motor anticlockwise running CLOCKWISE 1 motor clockwise running extern unsigned char Driver Mode Description Motor drive method Value HALL SENSOR 0 hall sensor drive SENSOR LESS 1 sensorless drive extern unsigned char Start Motor Value FALSE 0 the
7. e choose hall sensor drive Sensor Less Start unsigned short start duty on unsigned short start_period unsigned short normal_duty_on unsigned short normal period When we choose sensorless drive we can change start period for adjusting the motor start carrier frequency and we change normal period for adjusting motor normal run carrier frequency It should keep the start duty as same as normal duty otherwise the motor can t start normally Adjust start When we choose sensorless drive maybe we should adjust some parameters to keep motor start normally There are two functions need to adjust Sensor Less Start unsigned short start duty on unsigned shor start period unsigned short normal duty on unsigned short normal period Motor Parm unsigned long speed con unsigned short csd unsigned short cad unsigned short camaskt unsigned short stmaskt Gh Gt Ge Ct We know when we just start motor There is no Back EMF can checked So we use a timer to help motor change arm and bring Back EMF But how long we set timer and how large duty need If the time of the timer is large or small the motor can t run normally If the duty is large the motor will over current and can t start If the duty is small the Back EMF of motor is very weak and we can t check Usually we fix one parameter adjust another one For example we fixed start_duty_on start duty then we change stmaskt timer We also can fixed stamaskt timer then we
8. e that the motor is running under normal status The following flow chart shows how to change the motor speed NO Is Motor State MOTOR NORMAL Motor Set Change Speed 6 1 3 Set Motor Rotation Direction To set motor rotation direction please ensure that the motor is under ready status The following flow chart shows how to set the motor rotation direction NO Is Motor State MOTOR READY Rotation DirectionZANTI CLOCKWISE Or Rotation DirectionZCLOCKWISE MCU AN 500067 E 14 Page 17 co FUJITSU 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 6 1 4 Stop Motor To stop a motor please ensure that the motor is under normal or startup status The following flow chart shows how to stop the motor Is Motor State MOTOR NORMAL Or Is Motor State MOTOR START Motor Stop 6 1 5 Get Motor Speed The following flow chart shows how to get motor actual speed Motor Get Speed MCU AN 500067 E 14 Page 18 co 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU 6 1 6 Adjust Parameter When we use this library to drive a new motor there are some parameters need to adjust Because of different motors need different parameters Adjust carrier frequency We can use the two functions to adjust motor carrier frequency Hall Sensor Start unsigned short duty on unsigned short period We can adjust period for motor carrier frequency when w
9. ion hall sensor sensorless brushless DC motor control using the provided F2MC 8L 8FX SOFTUNE C library and the Fujitsu MB95F330 8 bit microcontroller The operation principles specification library installation library function description and operation of library functions are included MB95F330 series 8 bit Micro controller can be used to control the operation of a 3 phase brushless DC motor using the 120 conduction inverter control solution MCU AN 500067 E 14 Page 4 120 DC Inverter Control SOFTUNE LIB Application Note V1 4 FUJITSU 2 Operation Principles and Theory 2 4 Hall Sensor Drive Below is the brief working principle for MCU to drive motor with hall sensor A multi pulse generator outputs six switch signals to drive IGBT inverter Three channel hall sensor signals are detected by MCU input capture to achieve motor position One channel over current signal is output by IGBT inverter to MCU to protect the whole system Multi pulse Generator 4 Up OPTO Un OPT1 Vp OPT2 Phase voltage and reference levl MCU AN 500067 E 14 Page 5 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU One electrical cycle is divided into 6 states The relationship between three channel hall sensor signals H1 H2 H3 and six channel inverter switch signals Up Un Vp Vn Wp Wn is shown as below State 1 N o Q o I I T gt gt
10. nnnnnannnnnnnanannnnaunnnananannannanannannnnaaaa 7 222 Noma RUN 8 HW DESCRIPTION ys cscs chic eee acs chee ade eect eect eke 9 4 LIBRARY INSTALLATION erint saaana aiaa 10 4 1 TOig c c 10 42 drei REED 10 5 LIBRARY FUNCTIONS AND EXTERNAL VARIABLES eene 11 SYN K stud ados 12 5 2 External Variables sss eene nnne nnne 15 6 USAGE OF LIBRARY FUNCTIONS cess se annt x ma co taa nra cxx ean tanen 16 6 1 Operation POW em 16 Start Motor NU om 16 6 1 2 Change Motor 17 6 1 3 Set Motor Rotation Directions uie 17 MR MEE Dun a a a a 18 6 1 5 Get Motor co 18 6 1 5 Adjust Parameter x HERUM RE I eee 19 7 SAMPLE nasa nisu Inde eulos ce EE xa Sem eA 20 8 ADDITIONAL INFORMATION 21 MCU AN 500067 E 14 Page 3 co FUJITSU 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 1 Introduction This document describes the implementation of 120 conduct
11. otor Drive Library file contains all function modules V0 2 0 lib Deal DTTI Deal DTTI interrupt lt h file contains prototypes of the modules and global variables Header file contains the interrupt vector table declaration 4 2 Procedure There are 3 steps to begin using the Motor lib C library Y n F2MC 8L 8FX SOFTUNE after creation of a new project use PROJECT ADD MEMBER to add MB95F330 Motor Drive V0 2 0 lib and DTTI c as a member Y Include Motor h header file into C main program for external references Y Include myvect h header file into the module which uses directive pragma to generate the interrupt vector table Thus a project including Lib file is ready for the caller program MCU AN 500067 E 14 Page 10 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 O FUJITSU 5 Library Functions and External Variables There are 5 global variables in the library v v v v v Rotation Direction Start Motor Driver Mode Motor State Drive Level There are 9 functional modules for library control v v v v v v v v v Motor Init Sensor Less Start Motor Parm Motor Set Change Speed Motor Stop Sensor Less Normal Work Hall Sensor Start Hall Sensor Normal Work Motor Get Speed MCU AN 500067 E 14 Page 11 co FUJITSU 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 5 1 Function Syntax extern void Motor Init void Initialize
12. rive 29671096 Motor speed from 1000 rpm to 7000 rpm with hall sensor drive MCU AN 500067 E 14 Page 20 Q 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 FUJITSU 8 Additional Information For more information on how to use MB9595330 EV Board BGM adaptor and SOFTUNE please refer to Motor EV Board MB2146 440 E HW User Manual or visit Websites English version http www fujitsu com cn fsp services mcu mb95 application notes html Simplified Chinese Version http www fujitsu com cn fss services mcu mb95 application notes html MCU AN 500067 E 14 Page 21 co FUJITSU 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 co FUJITSU MCU AN 500067 E 14 Page 22
13. s the multi pulse generator of MCU and it uses three interruptions 16 bit reload timer ch 1 MPG writing timer or compare match and MPG The16 bit reload timer ch 1 and the MPG writing timer or compare match interruptions are closed in the library The MPG interruption is open In order to use this library more easily the connection between MCU and motor drive circuit should be as below OPT1 Un OPT2 Vp OPT3 Vn OPT4 Wp Motor drive circuit OPT5 Wn NIO W Back EMF SNI1 V Back EMF SNI2 U Back EMF DTTI Over Current Back EMF Drive Motor drive circuit DTTI Over Current Hall Sensor Drive Note OPTO OPT1 OPT2 OPT3 OPT4 OPT5 SNIO SNI1 SNI2 DTTI MCU pin Up U phase upper arm inverter switch signal Un U phase lower arm inverter switch signal Vp V phase upper arm inverter switch signal Vn V phase lower arm inverter switch signal Wp W phase upper arm inverter switch signal Wn W phase lower arm inverter switch signal H1 H2 H3 Hall sensor signal Over current Over current signal W Back EMF W phase back electromotive force V Back EMF V phase back electromotive force U Back EMF U phase back electromotive force Over Current Over current protection signal MCU AN 500067 E 14 Page 9 FUJITSU 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 4 Library Installation 41 Components The library package contains 3 files File name Usage MB95F330 M
14. u Define commutation delay duration Description Define the duration between change state and change arm Define the mask off period just after change arm Define the mask off period during startup speed 6000000 2us x number of pole pair csd in x100 electric angle Input parameters cag in x100 electric angle camaskt in x100 electric angle stmaskt in 1us unit Motor Parm 15000000 0 200 200 2000 2 pole pair gt 60 2us x 2 15000000 0 change state delay after back EMF zero crossing gt 0 2 change arm delay after back EMF zero crossing gt 200 After change arm mask time 2 200 During startup 2ms 2000 x 1us gt 2000 extern void Motor Set Change Speed unsigned short speed Description Set or change target rotational speed in RPM whenever sensorless drive or hall sensor drive is used Input parameters speed in RPM Motor Set Change Speed 6000 Set target speed to 6000rpm Stop motor without brake All driving outputs are inactivated Description Speed checking timer is stopped Multi function timer is reset Input capture edge detection are disabled em MN MCU AN 500067 E 14 Page 13 co FUJITSU 120 DC Inverter Control SOFTUNE C LIB Application Note V1 4 Count change arm time extern void Hall Sensor Start unsigned short duty on unsigned short period Start motor from reset with hall sensor drive M Motor_State will be MOTOR_NORMAL or Description MOTOR_FAILURE
Download Pdf Manuals
Related Search