新增定速运动功能。

This commit is contained in:
TAO Cheng
2013-09-12 19:39:35 +08:00
parent 3dc4f2887c
commit f14a72d4e7
10 changed files with 435 additions and 93 deletions
@@ -2152,3 +2152,24 @@ Init:Open device succeed .
_start_machine
Exit: Exit_SO7Usb
Destruct Cso7_Proto.
Construct Cso7_Proto.
Init:Open device succeed .
_start_machine
Exit: Exit_SO7Usb
Destruct Cso7_Proto.
Construct Cso7_Proto.
Init:Open device succeed .
_start_machine
Exit: Exit_SO7Usb
Destruct Cso7_Proto.
@@ -1,9 +1,21 @@
[HARDWARE]
SPEED_BASE_X1=5
SPEED_MAX_X1=168
SPEED_START_X1=28
SPEED_FRESH_X1=10
SPEED_SLOW_X1=0.509
MOVETOSPEED_FAST_X=20.00000000
MOVETOSPEED_SLOW_X=10.00000000
MOVETOSPEED_SCALE_X=1.00000000
;
MOVETOSPEED_FAST_Y=20.00000000
MOVETOSPEED_SLOW_Y=10.00000000
MOVETOSPEED_SCALE_Y=1.00000000
;
MOVETOSPEED_FAST_Z=20.00000000
MOVETOSPEED_SLOW_Z=10.00000000
MOVETOSPEED_SCALE_Z=1.00000000
;
SPEED_BASE_X1=0
SPEED_MAX_X1=0
SPEED_START_X1=10
SPEED_FRESH_X1=0
SPEED_SLOW_X1=0.000
;
SPEED_BASE_X2=3
SPEED_MAX_X2=50
@@ -14,26 +26,26 @@ SPEED_SLOW_X2=0.109
SPEED_BASE_X3=2
SPEED_MAX_X3=5
SPEED_START_X3=5
SPEED_FRESH_X3=100
SPEED_FRESH_X3=10
SPEED_SLOW_X3=0.001
;
SPEED_BASE_X4=2
SPEED_MAX_X4=0
SPEED_START_X4=50
SPEED_FRESH_X4=100
SPEED_FRESH_X4=10
SPEED_SLOW_X4=0.001
;
SPEED_BASE_X5=2
SPEED_BASE_X5=5
SPEED_MAX_X5=0
SPEED_START_X5=80
SPEED_FRESH_X5=100
SPEED_SLOW_X5=0.000
SPEED_FRESH_X5=10
SPEED_SLOW_X5=0.001
;
SPEED_BASE_Y1=5
SPEED_MAX_Y1=168
SPEED_START_Y1=28
SPEED_FRESH_Y1=10
SPEED_SLOW_Y1=0.600
SPEED_BASE_Y1=0
SPEED_MAX_Y1=0
SPEED_START_Y1=10
SPEED_FRESH_Y1=0
SPEED_SLOW_Y1=0.000
;
SPEED_BASE_Y2=3
SPEED_MAX_Y2=60
@@ -43,27 +55,27 @@ SPEED_SLOW_Y2=0.200
;
SPEED_BASE_Y3=2
SPEED_MAX_Y3=5
SPEED_START_Y3=5
SPEED_FRESH_Y3=100
SPEED_START_Y3=3
SPEED_FRESH_Y3=10
SPEED_SLOW_Y3=0.001
;
SPEED_BASE_Y4=2
SPEED_MAX_Y4=0
SPEED_START_Y4=50
SPEED_FRESH_Y4=100
SPEED_FRESH_Y4=10
SPEED_SLOW_Y4=0.001
;
SPEED_BASE_Y5=2
SPEED_BASE_Y5=5
SPEED_MAX_Y5=0
SPEED_START_Y5=80
SPEED_FRESH_Y5=100
SPEED_SLOW_Y5=0.000
SPEED_FRESH_Y5=10
SPEED_SLOW_Y5=0.001
;
SPEED_BASE_Z1=5
SPEED_MAX_Z1=130
SPEED_START_Z1=28
SPEED_FRESH_Z1=10
SPEED_SLOW_Z1=0.509
SPEED_BASE_Z1=0
SPEED_MAX_Z1=0
SPEED_START_Z1=10
SPEED_FRESH_Z1=0
SPEED_SLOW_Z1=0.000
;
SPEED_BASE_Z2=3
SPEED_MAX_Z2=60
@@ -74,27 +86,27 @@ SPEED_SLOW_Z2=0.109
SPEED_BASE_Z3=2
SPEED_MAX_Z3=5
SPEED_START_Z3=5
SPEED_FRESH_Z3=100
SPEED_FRESH_Z3=10
SPEED_SLOW_Z3=0.001
;
SPEED_BASE_Z4=2
SPEED_MAX_Z4=0
SPEED_START_Z4=50
SPEED_FRESH_Z4=100
SPEED_FRESH_Z4=10
SPEED_SLOW_Z4=0.001
;
SPEED_BASE_Z5=2
SPEED_BASE_Z5=5
SPEED_MAX_Z5=0
SPEED_START_Z5=80
SPEED_FRESH_Z5=100
SPEED_SLOW_Z5=0.000
SPEED_FRESH_Z5=10
SPEED_SLOW_Z5=0.001
;
X_MOTOR_PRECISION=0.009
Y_MOTOR_PRECISION=0.009
Z_MOTOR_PRECISION=0.100
;
X_MOTOR_WHEELBASE=19.990
Y_MOTOR_WHEELBASE=31.556
Y_MOTOR_WHEELBASE=20.000
Z_MOTOR_WHEELBASE=2.999
;
MOTOR_PULSE_NUM=10000