Teleport entities on values saved in scoreboard

In Minecraft JE 1.16, I want to make an armor stand teleport to my position, but with an offset. I don’t want to include Y position because Y position will change depending if there are blocks in the way.

Currently, I have this code for saving the values:

execute store result score @e[tag=TEST] z run data get entity @p Pos[2]
execute store result score @e[tag=TEST] x run data get entity @p Pos[0]

And I’m using these commands to make the entity teleport if it is stuck in a block:

execute as @e[tag=TEST] at @s unless block ~ ~ ~ air run tp @s ~ ~1 ~
execute as @e[tag=TEST] at @s if block ~ ~-1 ~ air run tp @s ~ ~-1 ~

This is all good so far, but I don’t know how to move the armour stand based on the scoreboard score. I can’t use a normal /tp because it will break and then my Y-position of the armor stand also won’t work.