diff --git a/components/xtensa/expression_with_stack_xtensa.c b/components/xtensa/expression_with_stack_xtensa.c
index 74829d7e8..b61282427 100644
--- a/components/xtensa/expression_with_stack_xtensa.c
+++ b/components/xtensa/expression_with_stack_xtensa.c
@@ -19,7 +19,8 @@
 StackType_t * esp_switch_stack_setup(StackType_t *stack, size_t stack_size)
 {
 #if CONFIG_FREERTOS_WATCHPOINT_END_OF_STACK
-    int watchpoint_place = (((int)stack + 31) & ~31);
+    esp_clear_watchpoint(0);
+    uint32_t watchpoint_place = ((uint32_t)stack + 32) & 0x1f ;
 #endif    
     StackType_t *top_of_stack =  (StackType_t *)&stack[0] +                  
             ((stack_size * sizeof(StackType_t)) / sizeof(StackType_t));
@@ -35,7 +36,7 @@ StackType_t * esp_switch_stack_setup(StackType_t *stack, size_t stack_size)
     frame->a1 = (UBaseType_t)top_of_stack;
 
 #if CONFIG_FREERTOS_WATCHPOINT_END_OF_STACK
-    esp_set_watchpoint(2, (char*)watchpoint_place, 32, ESP_WATCHPOINT_STORE);    
+    esp_set_watchpoint(0, (uint8_t *)watchpoint_place, 32, ESP_WATCHPOINT_STORE);    
 #endif
 
     return top_of_stack;           
diff --git a/components/xtensa/expression_with_stack_xtensa_asm.S b/components/xtensa/expression_with_stack_xtensa_asm.S
index f868131ba..b01cc5280 100644
--- a/components/xtensa/expression_with_stack_xtensa_asm.S
+++ b/components/xtensa/expression_with_stack_xtensa_asm.S
@@ -26,14 +26,14 @@
 esp_switch_stack_enter:
 
     #ifndef __XTENSA_CALL0_ABI__
-        entry   sp, 0x10
-        mov   a4, a1
-        s32i   a4, a3, 0 /* on a3 there is a safe place to save the current stack */
-        l32i   a4, a2, 0 /* obtains the user allocated stack buffer */
-        mov   a1, a4     /* sp register now contains caller specified stack */
-        retw
+    entry   sp, 0x10
+    mov   a4, a1
+    s32i   a4, a3, 0 /* on a3 there is a safe place to save the current stack */
+    l32i   a4, a2, 0 /* obtains the user allocated stack buffer */
+    mov   a1, a4     /* sp register now contains caller specified stack */
+    retw
     #else 
-        #error "this code is written for Window ABI"
+    #error "this code is written for Window ABI"
     #endif
 
 /**
@@ -45,17 +45,12 @@ esp_switch_stack_enter:
 esp_switch_stack_exit:
 
     #ifndef __XTENSA_CALL0_ABI__
-        entry   sp, 0x10
+    entry   sp, 0x10
 
-#if CONFIG_FREERTOS_WATCHPOINT_END_OF_STACK        
-        movi a6, 2
-        movi a4, esp_clear_watchpoint
-        callx4 a4 /* clear the watchpoint before releasing stack */
-#endif
+    l32i a4, a2, 0  /* recover the original task stack */
+    mov a1, a4      /* put it on sp register again */
+    retw
 
-        l32i a4, a2, 0  /* recover the original task stack */
-        mov a1, a4      /* put it on sp register again */
-        retw
     #else 
-        #error "this code is written for Window ABI"
+    #error "this code is written for Window ABI"
     #endif