aboutsummaryrefslogtreecommitdiffstats
path: root/Software/Embedded_SW/Embedded/Modules/Control
diff options
context:
space:
mode:
authorRoy Ben-Shabat <Roy@Twine-s.com>2018-03-26 14:22:12 +0300
committerRoy Ben-Shabat <Roy@Twine-s.com>2018-03-26 14:22:12 +0300
commit2f1579f22a700dc64533532d533dfacb3a3531d0 (patch)
treef88cf8c1ae220e2d632965a9290ee788f3dcd3cc /Software/Embedded_SW/Embedded/Modules/Control
parent1061758f95b7ba633e6bcc2c3556b42f033b1a79 (diff)
parentbca898b563219f5d02fb7d611a49f2a20306f214 (diff)
downloadTango-2f1579f22a700dc64533532d533dfacb3a3531d0.tar.gz
Tango-2f1579f22a700dc64533532d533dfacb3a3531d0.zip
Merge branch 'master' of https://twinetfs.visualstudio.com/_git/Tango
Diffstat (limited to 'Software/Embedded_SW/Embedded/Modules/Control')
-rw-r--r--Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c7
1 files changed, 6 insertions, 1 deletions
diff --git a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
index ded4c9f9e..c242401fd 100644
--- a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
+++ b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
@@ -47,6 +47,7 @@ uint32_t ADC_Data[MAX_ADC_DEVICES] = {0};
uint32_t TemperatureSensor_Data[MAX_TEMPERATURE_SENSOR_ID] = {0};
uint32_t MotorSpeed_Data[MOTOR_SPARE1_1] = {0};
uint32_t MotorStatus_Data[MOTOR_SPARE1_1] = {0};
+uint32_t MotorPosition_Data[MOTOR_SPARE1_1] = {0};
bool MotorBusy_Data[MOTOR_SPARE1_1] = {true};
/******************** GLOBAL PARAMETERS ********************************************/
@@ -154,7 +155,11 @@ uint32_t MillisecLoop(uint32_t tick)
MotorStatus_Data[MOTOR_RDRIVING] = MotorGetStatusFromFPGA(MOTOR_RDRIVING);
//gather Dancer data from FPGA
//gather data from FPGA
-
+ if (Ten_msTick)
+ {
+ MotorPosition_Data[MOTOR_SCREW] = MotorGetPositionFromFPGA(MOTOR_SCREW);
+ MotorPosition_Data[MOTOR_RDRIVING] = MotorGetPositionFromFPGA(MOTOR_RDRIVING);
+ }
if (Hundred_msTick)
{
int adc_i;