Skip to content
GitLab
Explore
Sign in
Primary navigation
Search or go to…
Project
U
ucbus-stepper
Manage
Activity
Members
Labels
Plan
Issues
Issue boards
Milestones
Wiki
Code
Merge requests
Repository
Branches
Commits
Tags
Repository graph
Compare revisions
Snippets
Build
Pipelines
Jobs
Pipeline schedules
Artifacts
Deploy
Releases
Model registry
Operate
Environments
Monitor
Incidents
Analyze
Value stream analytics
Contributor analytics
CI/CD analytics
Repository analytics
Model experiments
Help
Help
Support
GitLab documentation
Compare GitLab plans
GitLab community forum
Contribute to GitLab
Provide feedback
Keyboard shortcuts
?
Snippets
Groups
Projects
Show more breadcrumbs
Jake Read
ucbus-stepper
Commits
9d2a4f8b
Commit
9d2a4f8b
authored
2 years ago
by
Jake Read
Browse files
Options
Downloads
Patches
Plain Diff
statewise control back online
parent
9fef161d
No related branches found
No related tags found
No related merge requests found
Changes
2
Show whitespace changes
Inline
Side-by-side
Showing
2 changed files
firmware/axl-stepper/src/axl
+1
-1
1 addition, 1 deletion
firmware/axl-stepper/src/axl
firmware/axl-stepper/src/main.cpp
+21
-23
21 additions, 23 deletions
firmware/axl-stepper/src/main.cpp
with
22 additions
and
24 deletions
axl
@
bda32c5b
Compare
0b8fc43e
...
bda32c5b
Subproject commit
0b8fc43e4c0ac860abc96a51eccc5d222ed11bb6
Subproject commit
bda32c5b94c68a6f674d8ccac94a9abf4524e9d5
This diff is collapsed.
Click to expand it.
firmware/axl-stepper/src/main.cpp
+
21
−
23
View file @
9d2a4f8b
...
...
@@ -20,8 +20,8 @@
//OSAP osap("axl-stepper_y-right");
//OSAP osap("axl-stepper_x");
//OSAP osap("axl-stepper_e");
OSAP
osap
(
"axl-stepper_z"
);
//
OSAP osap("axl-stepper_rl");
//
OSAP osap("axl-stepper_z");
OSAP
osap
(
"axl-stepper_rl"
);
// OSAP osap("axl-stepper_rr");
// -------------------------------------------------------- 0: USB Serial
...
...
@@ -54,8 +54,7 @@ Endpoint axlSettingsEP(&osap, "axlSettings", onAXLSettingsData);
// -------------------------------------------------------- 3: Axl Modal Requests
EP_ONDATA_RESPONSES
onStateData
(
uint8_t
*
data
,
uint16_t
len
){
/*
EP_ONDATA_RESPONSES
onStateRequestData
(
uint8_t
*
data
,
uint16_t
len
){
// check for partner-config badness,
if
(
len
!=
AXL_NUM_DOF
*
4
+
2
){
OSAP
::
error
(
"state req has bad DOF count"
);
return
EP_ONDATA_REJECT
;
}
// we have accel, rate, posn data,
...
...
@@ -96,44 +95,43 @@ EP_ONDATA_RESPONSES onStateData(uint8_t* data, uint16_t len){
break
;
}
}
*/
// since we routinely update it w/ actual states (not requests)
return
EP_ONDATA_REJECT
;
}
Endpoint
statesEP
(
&
osap
,
"states"
,
onStateData
);
Endpoint
state
Request
sEP
(
&
osap
,
"state
Request
s"
,
onState
Request
Data
);
// -------------------------------------------------------- 4: Axl Queue Addition
EP_ONDATA_RESPONSES
onSegmentData
(
uint8_t
*
data
,
uint16_t
len
){
// careful, if you add a new field in axlPlannedSegment_t, recall you have to copy
// it manually into the buffer (!)
axlPlannedSegment_t
move
;
axlPlannedSegment_t
segment
;
uint16_t
rptr
=
0
;
// location of
move
-in-sequence, to count continuity,
move
.
segmentNumber
=
ts_readUint32
(
data
,
&
rptr
);
// location of
segment
-in-sequence, to count continuity,
segment
.
segmentNumber
=
ts_readUint32
(
data
,
&
rptr
);
// which actuator is requested to ack this mfer,
move
.
returnActuator
=
ts_readUint8
(
data
,
&
rptr
);
segment
.
returnActuator
=
ts_readUint8
(
data
,
&
rptr
);
// is it the end of this stream ?
move
.
isLastSegment
=
ts_readBoolean
(
data
,
&
rptr
);
OSAP
::
debug
(
"segnum, isLast "
+
String
(
move
.
segmentNumber
)
+
", "
+
String
(
move
.
isLastSegment
));
// unit vector describing
move
's direction,
segment
.
isLastSegment
=
ts_readBoolean
(
data
,
&
rptr
);
OSAP
::
debug
(
"segnum, isLast "
+
String
(
segment
.
segmentNumber
)
+
", "
+
String
(
segment
.
isLastSegment
));
// unit vector describing
segment
's direction,
for
(
uint8_t
a
=
0
;
a
<
AXL_NUM_DOF
;
a
++
){
move
.
unitVector
.
axis
[
a
]
=
ts_readFloat32
(
data
,
&
rptr
);
segment
.
unitVector
.
axis
[
a
]
=
ts_readFloat32
(
data
,
&
rptr
);
}
// start vel, accel-rate (up, and down), max velocity, final velocity, distance (all +ve)
move
.
vi
=
ts_readFloat32
(
data
,
&
rptr
);
move
.
accel
=
ts_readFloat32
(
data
,
&
rptr
);
move
.
vmax
=
ts_readFloat32
(
data
,
&
rptr
);
move
.
vf
=
ts_readFloat32
(
data
,
&
rptr
);
move
.
distance
=
ts_readFloat32
(
data
,
&
rptr
);
segment
.
vi
=
ts_readFloat32
(
data
,
&
rptr
);
segment
.
accel
=
ts_readFloat32
(
data
,
&
rptr
);
segment
.
vmax
=
ts_readFloat32
(
data
,
&
rptr
);
segment
.
vf
=
ts_readFloat32
(
data
,
&
rptr
);
segment
.
distance
=
ts_readFloat32
(
data
,
&
rptr
);
// and send it...
axl_add
Move
ToQueue
(
move
);
axl_add
Segment
ToQueue
(
segment
);
// don't write to endpoint...
return
EP_ONDATA_REJECT
;
}
Endpoint
precalculated
Move
EP
(
&
osap
,
"segmentsIn"
,
onSegmentData
);
Endpoint
precalculated
Segment
EP
(
&
osap
,
"segmentsIn"
,
onSegmentData
);
// -------------------------------------------------------- 5: Halt Input
...
...
@@ -216,7 +214,7 @@ void loop() {
if
(
axlDataLen
){
segmentAckOutEP
.
write
(
axlData
,
axlDataLen
);
}
// check for queue
Move
Complete
// check for queue
Segment
Complete
axlDataLen
=
axl_getSegmentCompleteMsg
(
axlData
);
if
(
axlDataLen
){
segmentCompleteOutEP
.
write
(
axlData
,
axlDataLen
);
...
...
This diff is collapsed.
Click to expand it.
Preview
0%
Loading
Try again
or
attach a new file
.
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Save comment
Cancel
Please
register
or
sign in
to comment