def check_center(params, white_field, dark_field):
global_PVs = aps2bm.init_general_PVs(params)
log.warning(' *** CHECK center of mass for the centered sphere')
log.info(' *** moving rotary stage to %f deg position ***' % float(0))
global_PVs["Motor_SampleRot"].put(float(0), wait=True, timeout=600.0)
log.info(' *** acquire sphere at %f deg position ***' % float(0))
sphere_0 = util.normalize(flir.take_image(global_PVs, params), white_field,
dark_field)
cmass_0 = util.center_of_mass(sphere_0)
log.warning(
' *** center of mass for the centered sphere at 0 deg: [%f,%f] ***' %
(cmass_0[1], cmass_0[0]))
def adjust_pitch(params, dark_field, white_field, angle_shift):
global_PVs = aps2bm.init_general_PVs(params)
log.warning(' *** Adjusting pitch ***')
log.info(
' *** acquire sphere after moving it along the beam axis by 1mm ***')
global_PVs["Motor_Sample_Top_90"].put(
global_PVs["Motor_Sample_Top_90"].get() - 1.0,
wait=True,
timeout=600.0)
log.info(' *** moving rotary stage to %f deg position ***' %
float(0 + angle_shift))
global_PVs["Motor_SampleRot"].put(float(0 + angle_shift),
wait=True,
timeout=600.0)
log.info(' *** acquire sphere at %f deg position ***' %
float(0 + angle_shift))
sphere_0 = util.normalize(flir.take_image(global_PVs, params), white_field,
dark_field)
log.info(' *** moving rotary stage to %f deg position ***' %
float(0 + angle_shift))
global_PVs["Motor_SampleRot"].put(float(180 + angle_shift),
wait=True,
timeout=600.0)
log.info(' *** acquire sphere at %f deg position ***' %
float(180 + angle_shift))
sphere_180 = util.normalize(flir.take_image(global_PVs, params),
white_field, dark_field)
cmass_0 = util.center_of_mass(sphere_0)
cmass_180 = util.center_of_mass(sphere_180)
log.info(' *** center of mass for the initial sphere (%f,%f) ***' %
(cmass_0[1], cmass_0[0]))
log.info(' *** center of mass for the shifted sphere (%f,%f) ***' %
(cmass_180[1], cmass_180[0]))
pitch = np.rad2deg(
np.arctan((cmass_180[0] - cmass_0[0]) * params.image_resolution /
1000 / 2.0))
log.warning(' *** found pitch error: %f' % pitch)
log.info(' *** acquire sphere back along the beam axis by -1mm ***')
global_PVs["Motor_Sample_Top_90"].put(
global_PVs["Motor_Sample_Top_90"].get() + 1.0,
wait=True,
timeout=600.0)
log.warning(' *** change pitch to %f ***' %
float(global_PVs["Motor_Pitch"].get() - pitch))
global_PVs["Motor_Pitch"].put(global_PVs["Motor_Pitch"].get() - pitch,
wait=True,
timeout=600.0)
global_PVs["Motor_SampleRot"].put(float(0 + angle_shift),
wait=True,
timeout=600.0)
log.info(' *** TEST: acquire sphere at %f deg position ***' %
float(0 + angle_shift))
sphere_0 = util.normalize(flir.take_image(global_PVs, params), white_field,
dark_field)
cmass_0 = util.center_of_mass(sphere_0)
log.info(' *** TEST: center of mass for the sphere at 0 deg (%f,%f) ***' %
(cmass_0[1], cmass_0[0]))
def adjust_roll(params, dark_field, white_field, angle_shift):
# angle_shift is the correction that is needed to apply to the rotation axis position
# to align the Z stage on top of the rotary stage with the beam
global_PVs = aps2bm.init_general_PVs(params)
log.warning(' *** Adjusting roll ***')
log.info(' *** moving rotary stage to %f deg position ***' %
float(0 + angle_shift))
global_PVs["Motor_SampleRot"].put(float(0 + angle_shift),
wait=True,
timeout=600.0)
log.info(' *** moving sphere to the detector border ***')
global_PVs["Motor_Sample_Top_0"].put(
global_PVs["Motor_Sample_Top_0"].get() +
global_PVs['Cam1_SizeX'].get() / 2 * params.image_resolution / 1000 -
((SPHERE_DIAMETER / 2) + GAP),
wait=True,
timeout=600.0)
log.info(' *** acquire sphere at %f deg position ***' %
float(0 + angle_shift))
sphere_0 = util.normalize(flir.take_image(global_PVs, params), white_field,
dark_field)
log.info(' *** moving rotary stage to %f deg position ***' %
float(180 + angle_shift))
global_PVs["Motor_SampleRot"].put(float(180 + angle_shift),
wait=True,
timeout=600.0)
log.info(' *** acquire sphere at %f deg position ***' %
float(180 + angle_shift))
sphere_180 = util.normalize(flir.take_image(global_PVs, params),
white_field, dark_field)
cmass_0 = util.center_of_mass(sphere_0)
cmass_180 = util.center_of_mass(sphere_180)
log.info(' *** center of mass for the sphere at 0 deg (%f,%f) ***' %
(cmass_0[1], cmass_0[0]))
log.info(' *** center of mass for the sphere at 180 deg (%f,%f) ***' %
(cmass_180[1], cmass_180[0]))
roll = np.rad2deg(
np.arctan((cmass_180[0] - cmass_0[0]) / (cmass_180[1] - cmass_0[1])))
log.warning(' *** found roll error: %f' % roll)
log.info(' *** moving rotary stage to %f deg position ***' %
float(0 + angle_shift))
global_PVs["Motor_SampleRot"].put(float(0 + angle_shift),
wait=True,
timeout=600.0)
log.info(' *** moving sphere back to the detector center ***')
global_PVs["Motor_Sample_Top_0"].put(
global_PVs["Motor_Sample_Top_0"].get() -
(global_PVs['Cam1_SizeX'].get() / 2 * params.image_resolution / 1000 -
((SPHERE_DIAMETER / 2) + GAP)),
wait=True,
timeout=600.0)
log.info(' *** find shifts resulting by the roll change ***')
log.info(' *** acquire sphere at the current roll position ***')
sphere_0 = util.normalize(flir.take_image(global_PVs, params), white_field,
dark_field)
ang = roll / 2 # if roll is too big then ang should be decreased to keep the sphere in the field of view
log.info(' *** acquire sphere after testing roll change %f ***' %
float(global_PVs["Motor_Roll"].get() + ang))
global_PVs["Motor_Roll"].put(global_PVs["Motor_Roll"].get() + ang,
wait=True,
timeout=600.0)
sphere_1 = util.normalize(flir.take_image(global_PVs, params), white_field,
dark_field)
shift0 = register_translation(sphere_1, sphere_0, 100)[0][1]
shift1 = shift0 * np.sin(roll) * (np.cos(roll) * 1 / np.tan(ang) +
np.sin(roll))
log.info(
' *** the testing roll change corresponds to %f shift in x, calculated resulting roll change gives %f shift in x ***'
% (shift0, shift1))
log.warning(' *** change roll to %f ***' %
float(global_PVs["Motor_Roll"].get() + roll - ang))
global_PVs["Motor_Roll"].put(global_PVs["Motor_Roll"].get() + roll - ang,
wait=True,
timeout=600.0)
log.info(' *** moving sphere to the detector center ***')
global_PVs["Motor_SampleX"].put(global_PVs["Motor_SampleX"].get() -
shift1 * params.image_resolution / 1000,
wait=True,
timeout=600.0)
log.info(' *** TEST: acquire sphere at %f deg position ***' %
float(0 + angle_shift))
sphere_0 = util.normalize(flir.take_image(global_PVs, params), white_field,
dark_field)
cmass_0 = util.center_of_mass(sphere_0)
log.info(' *** TEST: center of mass for the sphere at 0 deg (%f,%f) ***' %
(cmass_0[1], cmass_0[0]))
def adjust_center(params, dark_field, white_field):
global_PVs = aps2bm.init_general_PVs(params)
log.warning(' *** Adjusting center ***')
for ang in [params.adjust_center_angle_1, params.adjust_center_angle_2]:
log.warning(' *** take 3 spheres angular %f deg ***' % float(ang))
#sphere 0
log.info(' *** sphere 0')
log.info(' *** *** moving rotary stage to %f deg position ***' %
float(0))
global_PVs["Motor_SampleRot"].put(float(0), wait=True, timeout=600.0)
log.error(' *** *** acquire sphere at %f deg position ***' %
float(0))
sphere_0 = util.normalize(flir.take_image(global_PVs, params),
white_field, dark_field)
#sphere 1
log.info(' *** sphere 1')
log.info(' *** *** moving rotary stage to %f deg position ***' %
float(ang))
global_PVs["Motor_SampleRot"].put(float(ang), wait=True, timeout=600.0)
log.error(' *** *** acquire sphere at %f deg position ***' %
float(ang))
sphere_1 = util.normalize(flir.take_image(global_PVs, params),
white_field, dark_field)
#sphere 2
log.info(' *** sphere 2')
log.info(' *** *** moving rotary stage to %f deg position ***' %
float(2 * ang))
global_PVs["Motor_SampleRot"].put(float(2 * ang),
wait=True,
timeout=600.0)
log.error(' *** *** acquire sphere at %f deg position ***' %
float(2 * ang))
sphere_2 = util.normalize(flir.take_image(global_PVs, params),
white_field, dark_field)
# find shifts
shift0 = register_translation(sphere_1, sphere_0, 100)[0][1]
shift1 = register_translation(sphere_2, sphere_1, 100)[0][1]
a = ang * np.pi / 180
# x=-(1/4) (d1+d2-2 d1 Cos[a]) Csc[a/2]^2,
x = -(1 / 4) * (shift0 + shift1 - 2 * shift0 * np.cos(a)) * 1 / np.sin(
a / 2)**2
# r = 1/2 Csc[a/2]^2 Csc[a] Sqrt[(d1^2+d2^2-2 d1 d2 Cos[a]) Sin[a/2]^2]
r = 1 / 2 * 1 / np.sin(a / 2)**2 * 1 / np.sin(a) * np.sqrt(
np.abs((shift0**2 + shift1**2 - 2 * shift0 * shift1 * np.cos(a)) *
np.sin(a / 2)**2))
# g = ArcCos[((-d1-d2+2 d1 Cos[a]) Sin[a])/(2 Sqrt[(d1^2+d2^2-2 d1 d2 Cos[a]) Sin[a/2]^2])]
g = np.arccos(
((-shift0 - shift1 + 2 * shift0 * np.cos(a)) * np.sin(a)) /
(2 * np.sqrt(
np.abs(
(shift0**2 + shift1**2 - 2 * shift0 * shift1 * np.cos(a)) *
np.sin(a / 2)**2))))
y = r * np.sin(g) * np.sign(shift0)
# find center of mass
cmass_0 = util.center_of_mass(sphere_0)
log.info(' ')
log.info(
' *** position of the initial sphere wrt to the rotation center (%f,%f) ***'
% (x, y))
log.info(' *** center of mass for the initial sphere (%f,%f) ***' %
(cmass_0[1], cmass_0[0]))
log.info(
' *** moving sphere to the position of the rotation center ***')
if (params.ask):
if util.yes_or_no(' *** Yes or No'):
move_center(params, cmass_0, x, y)
check_center(params, white_field, dark_field)
else:
log.warning(' No motion ')
exit()
else:
move_center(params, cmass_0, x, y)
check_center(params, white_field, dark_field)