Added StackMap test code
Bugfixed StackMap