PID bed control, still needs work

Signed-off-by: Matthew Schick <matthew.schick@gmail.com>
Make FW retract recovery a bit slower

Signed-off-by: Matthew Schick <matthew.schick@gmail.com>