Regen sct drivers with async and logging changes

This commit is contained in:
Douglas Clowes
2014-05-16 10:22:58 +10:00
parent 86673f6a8f
commit 81ed966092
7 changed files with 624 additions and 484 deletions

View File

@@ -3,16 +3,17 @@
#
namespace eval ::scobj::pfeiffer_hg {
set debug_threshold 0
set debug_threshold 5
if { ![info exists ::scobj::permlink_device_counter]} {
set ::scobj::permlink_device_counter 0
}
}
proc ::scobj::pfeiffer_hg::debug_log {debug_level debug_string} {
proc ::scobj::pfeiffer_hg::debug_log {tc_root debug_level debug_string} {
set catch_status [ catch {
if {${debug_level} >= ${::scobj::pfeiffer_hg::debug_threshold}} {
set fd [open "/tmp/pfeiffer_hg.log" "a"]
set debug_threshold [hgetpropval ${tc_root} debug_threshold]
if {${debug_level} >= ${debug_threshold}} {
set fd [open "/tmp/pfeiffer_hg_[basename ${tc_root}].log" "a"]
set line "[clock format [clock seconds] -format "%T"] ${debug_string}"
puts ${fd} "${line}"
close ${fd}
@@ -20,10 +21,19 @@ proc ::scobj::pfeiffer_hg::debug_log {debug_level debug_string} {
} catch_message ]
}
proc ::scobj::pfeiffer_hg::sics_log {debug_level debug_string} {
set catch_status [ catch {
set debug_threshold ${::scobj::pfeiffer_hg::debug_threshold}
if {${debug_level} >= ${debug_threshold}} {
sicslog "::scobj::pfeiffer_hg::${debug_string}"
}
} catch_message ]
}
# function to parse the read of a parameter on a device
proc ::scobj::pfeiffer_hg::ack_enq {tc_root} {
set catch_status [ catch {
debug_log 1 "ack_enq tc_root=${tc_root} sct=[sct] result=[sct result]"
debug_log ${tc_root} 1 "ack_enq tc_root=${tc_root} sct=[sct] result=[sct result]"
if { [hpropexists [sct] geterror] } {
hdelprop [sct] geterror
}
@@ -34,19 +44,19 @@ proc ::scobj::pfeiffer_hg::ack_enq {tc_root} {
sct geterror "${data}"
error "[sct geterror]"
}
# hook code starts
# ack_enq hook code starts
if {[string equal -nocase -length 1 ${data} "\x06"]} {
debug_log 1 "ack_enq received ACK, send ENQ"
debug_log ${tc_root} 1 "ack_enq received ACK, send ENQ"
sct send "\x05"
}
return "readPR1"
# hook code ends
# ack_enq hook code ends
if { [hpropexists [sct] geterror] } {
debug_log 1 "[sct] error: [sct geterror]"
debug_log ${tc_root} 9 "[sct] error: [sct geterror]"
error "[sct geterror]"
}
if { ${data} != [sct oldval] } {
debug_log 1 "[sct] changed to new:${data}, from old:[sct oldval]"
debug_log ${tc_root} 1 "[sct] changed to new:${data}, from old:[sct oldval]"
sct oldval ${data}
sct update ${data}
sct utime readtime
@@ -59,7 +69,7 @@ proc ::scobj::pfeiffer_hg::ack_enq {tc_root} {
# checklimits function for driveable interface
proc ::scobj::pfeiffer_hg::checklimits {tc_root} {
set catch_status [ catch {
debug_log 1 "checklimits tc_root=${tc_root} sct=[sct] target=[sct target]"
debug_log ${tc_root} 1 "checklimits tc_root=${tc_root} sct=[sct] target=[sct target]"
set setpoint [sct target]
if { [hpropexists [sct] lowerlimit] } {
set lolimit [sct lowerlimit]
@@ -73,7 +83,7 @@ proc ::scobj::pfeiffer_hg::checklimits {tc_root} {
# upperlimit not set, use target
set hilimit [sct target]
}
# hook code goes here
# checklimits hook code goes here
if { ${setpoint} < ${lolimit} || ${setpoint} > ${hilimit} } {
sct driving 0
error "setpoint ${setpoint} violates limits (${lolimit}..${hilimit}) on [sct]"
@@ -86,7 +96,7 @@ proc ::scobj::pfeiffer_hg::checklimits {tc_root} {
# check function for hset change
proc ::scobj::pfeiffer_hg::checkrange {tc_root} {
set catch_status [ catch {
debug_log 1 "checkrange tc_root=${tc_root} sct=[sct] target=[sct target]"
debug_log ${tc_root} 1 "checkrange tc_root=${tc_root} sct=[sct] target=[sct target]"
set setpoint [sct target]
if { [hpropexists [sct] lowerlimit] } {
set lolimit [sct lowerlimit]
@@ -100,7 +110,7 @@ proc ::scobj::pfeiffer_hg::checkrange {tc_root} {
# upperlimit not set, use target
set hilimit [sct target]
}
# hook code goes here
# checkrange hook code goes here
if { ${setpoint} < ${lolimit} || ${setpoint} > ${hilimit} } {
error "setpoint ${setpoint} violates limits (${lolimit}..${hilimit}) on [sct]"
}
@@ -112,7 +122,7 @@ proc ::scobj::pfeiffer_hg::checkrange {tc_root} {
# checkstatus function for driveable interface
proc ::scobj::pfeiffer_hg::checkstatus {tc_root} {
set catch_status [ catch {
# hook code goes here
# checkstatus hook code goes here
if {[sct driving]} {
set sp "[sct target]"
set pv "[hval ${tc_root}/[sct driveable]]"
@@ -146,13 +156,13 @@ proc ::scobj::pfeiffer_hg::checkstatus {tc_root} {
# function to request the read of a parameter on a device
proc ::scobj::pfeiffer_hg::getValue {tc_root nextState cmd_str} {
set catch_status [ catch {
debug_log 1 "getValue tc_root=${tc_root} sct=[sct] cmd=${cmd_str}"
debug_log ${tc_root} 1 "getValue tc_root=${tc_root} sct=[sct] cmd=${cmd_str}"
if { [hpropexists [sct] geterror] } {
hdelprop [sct] geterror
}
set cmd "${cmd_str}"
# hook code goes here
debug_log 1 "getValue sct send ${cmd}"
# getValue hook code goes here
debug_log ${tc_root} 1 "getValue sct send ${cmd}"
if {![string equal -nocase -length 10 ${cmd} "@@NOSEND@@"]} {
sct send "${cmd}"
}
@@ -164,9 +174,9 @@ proc ::scobj::pfeiffer_hg::getValue {tc_root nextState cmd_str} {
# halt function for driveable interface
proc ::scobj::pfeiffer_hg::halt {tc_root} {
set catch_status [ catch {
debug_log 1 "halt tc_root=${tc_root} sct=[sct] driving=[sct driving]"
debug_log ${tc_root} 1 "halt tc_root=${tc_root} sct=[sct] driving=[sct driving]"
### TODO hset [sct] [hval [sct]]
# hook code goes here
# halt hook code goes here
sct driving 0
return "idle"
} catch_message ]
@@ -176,8 +186,8 @@ proc ::scobj::pfeiffer_hg::halt {tc_root} {
# function to check the write parameter on a device
proc ::scobj::pfeiffer_hg::noResponse {tc_root} {
set catch_status [ catch {
debug_log 1 "noResponse tc_root=${tc_root} sct=[sct] resp=[sct result]"
# hook code goes here
debug_log ${tc_root} 1 "noResponse tc_root=${tc_root} sct=[sct] resp=[sct result]"
# noResponse hook code goes here
return "idle"
} catch_message ]
handle_exception ${catch_status} ${catch_message}
@@ -186,7 +196,7 @@ proc ::scobj::pfeiffer_hg::noResponse {tc_root} {
# pid function for PID control
proc ::scobj::pfeiffer_hg::pid_pressure {tc_root sp pv} {
set catch_status [ catch {
debug_log 1 "pid_pressure tc_root=${tc_root} sct=[sct] pv=${pv} sp=${sp}"
debug_log ${tc_root} 1 "pid_pressure tc_root=${tc_root} sct=[sct] pv=${pv} sp=${sp}"
sct pid_error [expr ${sp} - ${pv}]
set p_value [expr [sct pid_pvalue] * [sct pid_error]]
set d_value [expr [sct pid_dvalue] * (${pv} - [sct oldval])]
@@ -200,16 +210,19 @@ proc ::scobj::pfeiffer_hg::pid_pressure {tc_root sp pv} {
}
set i_value [expr [sct pid_ivalue] * [sct pid_integ]]
set pid [expr ${p_value} + ${i_value} + ${d_value}]
# hook code starts
# pid_pressure hook code starts
if { [hpropexists [sct] pid_control] } {
hsetprop [hgetpropval [sct] pid_control] pid_bias ${pid}
if { [hpropexists [hgetpropval [sct] pid_control] target] } {
hset [hgetpropval [sct] pid_control] [hgetpropval [hgetpropval [sct] pid_control] target]
set co [hgetpropval [sct] pid_control]
if { !([hpropexists ${co} pid_bias] && [hgetpropval ${co} pid_bias] == ${pid}) } {
hsetprop ${co} pid_bias ${pid}
if { [hpropexists ${co} target] } {
hset ${co} [hgetpropval ${co} target]
} else {
hset [hgetpropval [sct] pid_control] [hval [hgetpropval [sct] pid_control]]
hset ${co} [hval ${co}]
}
}
}
# hook code ends
# pid_pressure hook code ends
sct pid_output ${pid}
} catch_message ]
handle_exception ${catch_status} ${catch_message}
@@ -219,7 +232,7 @@ proc ::scobj::pfeiffer_hg::pid_pressure {tc_root sp pv} {
# function to parse the read of a parameter on a device
proc ::scobj::pfeiffer_hg::rdValue {tc_root} {
set catch_status [ catch {
debug_log 1 "rdValue tc_root=${tc_root} sct=[sct] result=[sct result]"
debug_log ${tc_root} 1 "rdValue tc_root=${tc_root} sct=[sct] result=[sct result]"
if { [hpropexists [sct] geterror] } {
hdelprop [sct] geterror
}
@@ -230,9 +243,9 @@ proc ::scobj::pfeiffer_hg::rdValue {tc_root} {
sct geterror "${data}"
error "[sct geterror]"
}
# hook code goes here
# rdValue hook code goes here
if { ${data} != [sct oldval] } {
debug_log 1 "[sct] changed to new:${data}, from old:[sct oldval]"
debug_log ${tc_root} 1 "[sct] changed to new:${data}, from old:[sct oldval]"
sct oldval ${data}
sct update ${data}
sct utime readtime
@@ -245,7 +258,7 @@ proc ::scobj::pfeiffer_hg::rdValue {tc_root} {
# function to parse the read of a parameter on a device
proc ::scobj::pfeiffer_hg::readPR1 {tc_root} {
set catch_status [ catch {
debug_log 1 "readPR1 tc_root=${tc_root} sct=[sct] result=[sct result]"
debug_log ${tc_root} 1 "readPR1 tc_root=${tc_root} sct=[sct] result=[sct result]"
if { [hpropexists [sct] geterror] } {
hdelprop [sct] geterror
}
@@ -256,7 +269,7 @@ proc ::scobj::pfeiffer_hg::readPR1 {tc_root} {
sct geterror "${data}"
error "[sct geterror]"
}
# hook code starts
# readPR1 hook code starts
set val [string range $data 3 12]
set status [string range $data 0 0]
set data ${val}
@@ -266,13 +279,13 @@ proc ::scobj::pfeiffer_hg::readPR1 {tc_root} {
set pv $val
pid_pressure ${tc_root} ${sp} ${pv}
}
# hook code ends
# readPR1 hook code ends
if { [hpropexists [sct] geterror] } {
debug_log 1 "[sct] error: [sct geterror]"
debug_log ${tc_root} 9 "[sct] error: [sct geterror]"
error "[sct geterror]"
}
if { ${data} != [sct oldval] } {
debug_log 1 "[sct] changed to new:${data}, from old:[sct oldval]"
debug_log ${tc_root} 1 "[sct] changed to new:${data}, from old:[sct oldval]"
sct oldval ${data}
sct update ${data}
sct utime readtime
@@ -285,13 +298,13 @@ proc ::scobj::pfeiffer_hg::readPR1 {tc_root} {
# function to request the read of a parameter on a device
proc ::scobj::pfeiffer_hg::sendPR1 {tc_root nextState cmd_str} {
set catch_status [ catch {
debug_log 1 "sendPR1 tc_root=${tc_root} sct=[sct] cmd=${cmd_str}"
debug_log ${tc_root} 1 "sendPR1 tc_root=${tc_root} sct=[sct] cmd=${cmd_str}"
if { [hpropexists [sct] geterror] } {
hdelprop [sct] geterror
}
set cmd "${cmd_str}"
# hook code goes here
debug_log 1 "sendPR1 sct send ${cmd}"
# sendPR1 hook code goes here
debug_log ${tc_root} 1 "sendPR1 sct send ${cmd}"
if {![string equal -nocase -length 10 ${cmd} "@@NOSEND@@"]} {
sct send "${cmd}"
}
@@ -303,17 +316,20 @@ proc ::scobj::pfeiffer_hg::sendPR1 {tc_root nextState cmd_str} {
# function to write a parameter value on a device
proc ::scobj::pfeiffer_hg::setPoint {tc_root nextState cmd_str} {
set catch_status [ catch {
debug_log 1 "setPoint tc_root=${tc_root} sct=[sct] cmd=${cmd_str}"
debug_log ${tc_root} 1 "setPoint tc_root=${tc_root} sct=[sct] cmd=${cmd_str}"
if { [hpropexists [sct] geterror] } {
hdelprop [sct] geterror
}
set par [sct target]
set cmd "${cmd_str}${par}"
# hook code starts
# setPoint hook code starts
sct pid_control /sample/tc9/Valve/Setpoint
# hook code ends
sct update [sct target]
set cmd "@@NOSEND@@"
set nextState "idle"
# setPoint hook code ends
if { [hpropexists [sct] geterror] } {
debug_log 1 "[sct] error: [sct geterror]"
debug_log ${tc_root} 9 "[sct] error: [sct geterror]"
error "[sct geterror]"
}
if { [hpropexists [sct] driving] } {
@@ -321,7 +337,7 @@ proc ::scobj::pfeiffer_hg::setPoint {tc_root nextState cmd_str} {
sct driving 1
}
}
debug_log 1 "setPoint sct send ${cmd}"
debug_log ${tc_root} 1 "setPoint sct send ${cmd}"
if {![string equal -nocase -length 10 ${cmd} "@@NOSEND@@"]} {
sct send "${cmd}"
}
@@ -333,19 +349,19 @@ proc ::scobj::pfeiffer_hg::setPoint {tc_root nextState cmd_str} {
# function to write a parameter value on a device
proc ::scobj::pfeiffer_hg::setValue {tc_root nextState cmd_str} {
set catch_status [ catch {
debug_log 1 "setValue tc_root=${tc_root} sct=[sct] cmd=${cmd_str}"
debug_log ${tc_root} 1 "setValue tc_root=${tc_root} sct=[sct] cmd=${cmd_str}"
if { [hpropexists [sct] geterror] } {
hdelprop [sct] geterror
}
set par [sct target]
set cmd "${cmd_str}${par}"
# hook code goes here
# setValue hook code goes here
if { [hpropexists [sct] driving] } {
if { [hpropexists [sct] writestatus] && [sct writestatus] == "start" } {
sct driving 1
}
}
debug_log 1 "setValue sct send ${cmd}"
debug_log ${tc_root} 1 "setValue sct send ${cmd}"
if {![string equal -nocase -length 10 ${cmd} "@@NOSEND@@"]} {
sct send "${cmd}"
}
@@ -354,8 +370,8 @@ proc ::scobj::pfeiffer_hg::setValue {tc_root nextState cmd_str} {
handle_exception ${catch_status} ${catch_message}
}
proc ::scobj::pfeiffer_hg::mk_sct_pfeiffer_hg { sct_controller name } {
debug_log 1 "mk_sct_pfeiffer_hg for ${name}"
proc ::scobj::pfeiffer_hg::mkDriver { sct_controller name } {
::scobj::pfeiffer_hg::sics_log 9 "::scobj::pfeiffer_hg::mkDriver for ${name}"
set ns "[namespace current]"
set catch_status [ catch {
@@ -433,65 +449,73 @@ proc ::scobj::pfeiffer_hg::mk_sct_pfeiffer_hg { sct_controller name } {
ansto_makesctdrive ${name}_pressure_setpoint ${scobj_hpath}/pressure/setpoint ${scobj_hpath}/pressure/sensor ${sct_controller}
}
hsetprop ${scobj_hpath} klass environment
# hook code starts
hsetprop ${scobj_hpath} debug_threshold 5
# mkDriver hook code starts
hsetprop ${scobj_hpath}/pressure/sensor read ${ns}::sendPR1 ${scobj_hpath} ack_enq {PR1}
hsetprop ${scobj_hpath}/pressure/sensor ack_enq ${ns}::ack_enq ${scobj_hpath}
# hook code ends
# mkDriver hook code ends
} catch_message ]
handle_exception ${catch_status} ${catch_message}
}
namespace eval ::scobj::pfeiffer_hg {
namespace export debug_threshold
namespace export debug_log
namespace export mk_sct_pfeiffer_hg
namespace export sics_log
namespace export mkDriver
}
proc add_pfeiffer_hg {name IP port} {
set catch_status [ catch {
set ns "::scobj::pfeiffer_hg"
${ns}::debug_log 1 "add_pfeiffer_hg ${name} ${IP} ${port}"
::scobj::pfeiffer_hg::sics_log 9 "add_pfeiffer_hg ${name} ${IP} ${port}"
if {[SplitReply [environment_simulation]]=="false"} {
if {[string equal -nocase "aqadapter" "${IP}"]} {
${ns}::debug_log 1 "makesctcontroller sct_${name} aqadapter ${port}"
::scobj::pfeiffer_hg::sics_log 9 "makesctcontroller sct_${name} aqadapter ${port}"
makesctcontroller sct_${name} aqadapter ${port}
} else {
${ns}::debug_log 1 "makesctcontroller sct_${name} std ${IP}:${port}"
::scobj::pfeiffer_hg::sics_log 9 "makesctcontroller sct_${name} std ${IP}:${port}"
makesctcontroller sct_${name} std ${IP}:${port}
}
}
${ns}::debug_log 1 "mk_sct_pfeiffer_hg sct_${name} ${name}"
${ns}::mk_sct_pfeiffer_hg sct_${name} ${name}
::scobj::pfeiffer_hg::sics_log 1 "::scobj::pfeiffer_hg::mkDriver sct_${name} ${name}"
::scobj::pfeiffer_hg::mkDriver sct_${name} ${name}
} catch_message ]
handle_exception ${catch_status} ${catch_message}
}
puts stdout "file evaluation of sct_pfeiffer_hg.tcl"
::scobj::pfeiffer_hg::debug_log 1 "file evaluation of sct_pfeiffer_hg.tcl"
::scobj::pfeiffer_hg::sics_log 9 "file evaluation of sct_pfeiffer_hg.tcl"
proc ::scobj::pfeiffer_hg::read_config {} {
set catch_status [ catch {
set ns "::scobj::pfeiffer_hg"
${ns}::debug_log 1 "Processing Config"
dict for {k v} $::config_dict {
${ns}::debug_log 1 "Inspecting $k:$v"
if { [dict exists $v "driver"] } {
${ns}::debug_log 1 "Has driver [dict get $v driver]"
if { [dict get $v "driver"] == "pfeiffer_hg" } {
${ns}::debug_log 1 "Correct driver, enabled = [dict get $v enabled]"
if { [dict get $v enabled] } {
set IP [dict get $v ip]
set PORT [dict get $v port]
set name [dict get $v name]
MakeAsyncProtocol ${name}_protocol
if { [dict exists $v "terminator"] } {
${name}_protocol sendterminator "[dict get $v "terminator"]"
${name}_protocol replyterminator "[dict get $v "terminator"]"
if { [dict exists $v "asyncqueue"] } {
set asyncqueue [dict get $v "asyncqueue"]
} else {
if { [dict exists $v "asyncprotocol"] } {
set asyncprotocol [dict get $v "asyncprotocol"]
} else {
set asyncprotocol ${name}_protocol
MakeAsyncProtocol ${asyncprotocol}
if { [dict exists $v "terminator"] } {
${asyncprotocol} sendterminator "[dict get $v "terminator"]"
${asyncprotocol} replyterminator "[dict get $v "terminator"]"
}
}
set asyncqueue ${name}_queue
set IP [dict get $v ip]
set PORT [dict get $v port]
MakeAsyncQueue ${asyncqueue} ${asyncprotocol} ${IP} ${PORT}
if { [dict exists $v "timeout"] } {
${asyncqueue} timeout "[dict get $v "timeout"]"
}
}
MakeAsyncQueue ${name}_queue ${name}_protocol ${IP} ${PORT}
if { [dict exists $v "timeout"] } {
${name}_queue timeout "[dict get $v "timeout"]"
}
add_pfeiffer_hg ${name} "aqadapter" ${name}_queue
add_pfeiffer_hg ${name} "aqadapter" ${asyncqueue}
}
}
}
@@ -499,8 +523,9 @@ proc ::scobj::pfeiffer_hg::read_config {} {
} catch_message ]
handle_exception ${catch_status} ${catch_message}
}
if { [info exists ::config_dict] } {
::scobj::pfeiffer_hg::read_config
} else {
::scobj::pfeiffer_hg:debug_log 1 "No config dict"
::scobj::pfeiffer_hg::sics_log 5 "No config dict"
}