dennisgunia/split-flap-controller
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

fix calibration

Browse Source
This commit is contained in:
Dennis Gunia
2025-09-13 00:58:14 +02:00
parent 942deb2c9c
commit cd832083c4
3 changed files with 10 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
software/firmware_module/module_rev0/src/main.c
View File

@@ -173,7 +173,7 @@ int main()
{ {
initialSetup(); initialSetup();
rs485_init(); rs485_init();
mctrl_init(); mctrl_init(calib_offset);
while (1 == 1) while (1 == 1)
{ {

8
software/firmware_module/module_rev0/src/mctrl.c
View File

@@ -46,9 +46,15 @@ uint16_t currentVoltage = 0; // current ADC reading
uint8_t currentFaultReadings = 0; // ticks with faulty readings (too many will uint8_t currentFaultReadings = 0; // ticks with faulty readings (too many will
// trip pwrdwn and sts_flag_fuse) // trip pwrdwn and sts_flag_fuse)
int STEPS_OFFSET = 0;
// initialize motor controller // initialize motor controller
void mctrl_init() void mctrl_init(int cal_offset)
{ {
if (cal_offset < 800){
STEPS_OFFSET = STEPS_OFFSET_DEF;
}else{
STEPS_OFFSET = cal_offset;
}
DDRC = 0x0F; // set all pins as outputs DDRC = 0x0F; // set all pins as outputs
PORTC = 0x00; // set all to LOW PORTC = 0x00; // set all to LOW

4
software/firmware_module/module_rev0/src/mctrl.h
View File

@@ -15,7 +15,7 @@
#define STEPS_PER_REV 2025 // steps per revolution #define STEPS_PER_REV 2025 // steps per revolution
#define STEPS_PER_FLAP 45 // steps per flap #define STEPS_PER_FLAP 45 // steps per flap
#define STEPS_ADJ 0 // added per flap to compensate for motor power down #define STEPS_ADJ 0 // added per flap to compensate for motor power down
#define STEPS_OFFSET 1400 // ansolute offset between home and first flap #define STEPS_OFFSET_DEF 1400 // ansolute offset between home and first flap
#define AMOUNTFLAPS 45 // amount of flaps installed in system #define AMOUNTFLAPS 45 // amount of flaps installed in system
#define STEPS_AFTERROT 255 // value to goto after current target flap is reached #define STEPS_AFTERROT 255 // value to goto after current target flap is reached
#define ERROR_DATASETS 8 // length of error array #define ERROR_DATASETS 8 // length of error array
@@ -33,7 +33,7 @@
#ifdef __cplusplus #ifdef __cplusplus
extern "C" { extern "C" {
#endif // __cplusplus #endif // __cplusplus
void mctrl_init(); void mctrl_init(int cal_offset);
void mctrl_step(); void mctrl_step();
void mctrl_set(uint8_t flap, uint8_t fullRotation); void mctrl_set(uint8_t flap, uint8_t fullRotation);