succd: calcuate change rate for safety interlock directly from adc ringbuffer
This commit is contained in:
parent
d3391b28ec
commit
9ad6ce7dad
3 changed files with 20 additions and 40 deletions
|
|
@ -17,8 +17,6 @@ type daemon struct {
|
|||
// Pirani gauge.
|
||||
adcPirani adc
|
||||
|
||||
lastPressures ringbuffer
|
||||
|
||||
failsafe bool
|
||||
highPressure bool
|
||||
|
||||
|
|
@ -125,10 +123,8 @@ func (d *daemon) processOnce(_ context.Context) error {
|
|||
d.aboveRough.process(float64(mbar))
|
||||
d.aboveHigh.process(float64(mbar))
|
||||
|
||||
d.lastPressures.AddValue(mbar)
|
||||
|
||||
// max rate of 1.0 in 500 ms because ringbuffer holds 5 values
|
||||
if d.lastPressures.MaxMinDiff() > 1.0 {
|
||||
if d.piraniRateOfChange() > 2.0 {
|
||||
if !d.failsafe {
|
||||
d.failsafe = true
|
||||
klog.Errorf("Pressure changed too fast; entering failsafe mode")
|
||||
|
|
@ -199,6 +195,25 @@ func (d *daemon) processOnce(_ context.Context) error {
|
|||
return nil
|
||||
}
|
||||
|
||||
func (d *daemon) piraniRateOfChange() float32 {
|
||||
max := d.adcPiraniVolts[0]
|
||||
min := d.adcPiraniVolts[0]
|
||||
for _, val := range d.adcPiraniVolts {
|
||||
if val < min {
|
||||
min = val
|
||||
}
|
||||
if val > max {
|
||||
max = val
|
||||
}
|
||||
}
|
||||
max_bar := math.Pow(10.0, float64(max)-8.5);
|
||||
max_mbar := float32(max_bar * 1000.0)
|
||||
min_bar := math.Pow(10.0, float64(min)-8.5);
|
||||
min_mbar := float32(min_bar * 1000.0)
|
||||
|
||||
return max_mbar - min_mbar
|
||||
}
|
||||
|
||||
// pirani returns the Pirani gauge voltage and pressure.
|
||||
func (d *daemon) pirani() (volts float32, mbar float32) {
|
||||
d.mu.RLock()
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue