You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
 
 
 

82 lines
2.7 KiB

  1. /***************************************************************************
  2. * Copyright (C) 2005, 2007 by Dominic Rath *
  3. * Dominic.Rath@gmx.de *
  4. * Copyright (C) 2010 Spencer Oliver *
  5. * spen@spen-soft.co.uk *
  6. * *
  7. * This program is free software; you can redistribute it and/or modify *
  8. * it under the terms of the GNU General Public License as published by *
  9. * the Free Software Foundation; either version 2 of the License, or *
  10. * (at your option) any later version. *
  11. * *
  12. * This program is distributed in the hope that it will be useful, *
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of *
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
  15. * GNU General Public License for more details. *
  16. * *
  17. * You should have received a copy of the GNU General Public License *
  18. * along with this program; if not, write to the *
  19. * Free Software Foundation, Inc., *
  20. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. *
  21. ***************************************************************************/
  22. .text
  23. .syntax unified
  24. .arch armv7-m
  25. .thumb
  26. .thumb_func
  27. .align 2
  28. /* input parameters - */
  29. /* R0 = source address */
  30. /* R1 = destination address */
  31. /* R2 = number of writes */
  32. /* R3 = flash write command */
  33. /* R4 = constant to mask DQ7 bits (also used for Dq5 with shift) */
  34. /* output parameters - */
  35. /* R5 = 0x80 ok 0x00 bad */
  36. /* temp registers - */
  37. /* R6 = value read from flash to test status */
  38. /* R7 = holding register */
  39. /* unlock registers - */
  40. /* R8 = unlock1_addr */
  41. /* R9 = unlock1_cmd */
  42. /* R10 = unlock2_addr */
  43. /* R11 = unlock2_cmd */
  44. code:
  45. ldrh r5, [r0], #2
  46. strh r9, [r8]
  47. strh r11, [r10]
  48. strh r3, [r8]
  49. strh r5, [r1]
  50. nop
  51. busy:
  52. ldrh r6, [r1]
  53. eor r7, r5, r6
  54. ands r7, r4, r7
  55. beq cont /* b if DQ7 == Data7 */
  56. ands r6, r6, r4, lsr #2
  57. beq busy /* b if DQ5 low */
  58. ldrh r6, [r1]
  59. eor r7, r5, r6
  60. ands r7, r4, r7
  61. beq cont /* b if DQ7 == Data7 */
  62. mov r5, #0 /* 0x0 - return 0x00, error */
  63. bne done
  64. cont:
  65. subs r2, r2, #1 /* 0x1 */
  66. beq success
  67. add r1, r1, #2 /* 0x2 */
  68. b code
  69. success:
  70. mov r5, #128 /* 0x80 */
  71. b done
  72. done:
  73. bkpt #0
  74. .end