MacroRat / MouseCode

Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

mbed-dev/drivers/FlashIAP.cpp@46:b156ef445742, 2017-06-03 (annotated)

Committer:
sahilmgandhi
Date:
Sat Jun 03 00:22:44 2017 +0000
Revision:
46:b156ef445742
Parent:
18:6a4db94011d3 
Final code for internal battlebot competition.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sahilmgandhi 18:6a4db94011d3 1 /* mbed Microcontroller Library
sahilmgandhi 18:6a4db94011d3 2 * Copyright (c) 2017 ARM Limited
sahilmgandhi 18:6a4db94011d3 3 *
sahilmgandhi 18:6a4db94011d3 4 * Permission is hereby granted, free of charge, to any person obtaining a copy
sahilmgandhi 18:6a4db94011d3 5 * of this software and associated documentation files (the "Software"), to deal
sahilmgandhi 18:6a4db94011d3 6 * in the Software without restriction, including without limitation the rights
sahilmgandhi 18:6a4db94011d3 7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
sahilmgandhi 18:6a4db94011d3 8 * copies of the Software, and to permit persons to whom the Software is
sahilmgandhi 18:6a4db94011d3 9 * furnished to do so, subject to the following conditions:
sahilmgandhi 18:6a4db94011d3 10 *
sahilmgandhi 18:6a4db94011d3 11 * The above copyright notice and this permission notice shall be included in
sahilmgandhi 18:6a4db94011d3 12 * all copies or substantial portions of the Software.
sahilmgandhi 18:6a4db94011d3 13 *
sahilmgandhi 18:6a4db94011d3 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
sahilmgandhi 18:6a4db94011d3 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
sahilmgandhi 18:6a4db94011d3 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
sahilmgandhi 18:6a4db94011d3 17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
sahilmgandhi 18:6a4db94011d3 18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
sahilmgandhi 18:6a4db94011d3 19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
sahilmgandhi 18:6a4db94011d3 20 * SOFTWARE.
sahilmgandhi 18:6a4db94011d3 21 */
sahilmgandhi 18:6a4db94011d3 22
sahilmgandhi 18:6a4db94011d3 23 #include <string.h>
sahilmgandhi 18:6a4db94011d3 24 #include "FlashIAP.h"
sahilmgandhi 18:6a4db94011d3 25 #include "mbed_assert.h"
sahilmgandhi 18:6a4db94011d3 26
sahilmgandhi 18:6a4db94011d3 27
sahilmgandhi 18:6a4db94011d3 28 #ifdef DEVICE_FLASH
sahilmgandhi 18:6a4db94011d3 29
sahilmgandhi 18:6a4db94011d3 30 namespace mbed {
sahilmgandhi 18:6a4db94011d3 31
sahilmgandhi 18:6a4db94011d3 32 SingletonPtr<PlatformMutex> FlashIAP::_mutex;
sahilmgandhi 18:6a4db94011d3 33
sahilmgandhi 18:6a4db94011d3 34 static inline bool is_aligned(uint32_t number, uint32_t alignment)
sahilmgandhi 18:6a4db94011d3 35 {
sahilmgandhi 18:6a4db94011d3 36 if ((number % alignment) != 0) {
sahilmgandhi 18:6a4db94011d3 37 return false;
sahilmgandhi 18:6a4db94011d3 38 } else {
sahilmgandhi 18:6a4db94011d3 39 return true;
sahilmgandhi 18:6a4db94011d3 40 }
sahilmgandhi 18:6a4db94011d3 41 }
sahilmgandhi 18:6a4db94011d3 42
sahilmgandhi 18:6a4db94011d3 43 FlashIAP::FlashIAP()
sahilmgandhi 18:6a4db94011d3 44 {
sahilmgandhi 18:6a4db94011d3 45
sahilmgandhi 18:6a4db94011d3 46 }
sahilmgandhi 18:6a4db94011d3 47
sahilmgandhi 18:6a4db94011d3 48 FlashIAP::~FlashIAP()
sahilmgandhi 18:6a4db94011d3 49 {
sahilmgandhi 18:6a4db94011d3 50
sahilmgandhi 18:6a4db94011d3 51 }
sahilmgandhi 18:6a4db94011d3 52
sahilmgandhi 18:6a4db94011d3 53 int FlashIAP::init()
sahilmgandhi 18:6a4db94011d3 54 {
sahilmgandhi 18:6a4db94011d3 55 int ret = 0;
sahilmgandhi 18:6a4db94011d3 56 _mutex->lock();
sahilmgandhi 18:6a4db94011d3 57 if (flash_init(&_flash)) {
sahilmgandhi 18:6a4db94011d3 58 ret = -1;
sahilmgandhi 18:6a4db94011d3 59 }
sahilmgandhi 18:6a4db94011d3 60 _mutex->unlock();
sahilmgandhi 18:6a4db94011d3 61 return ret;
sahilmgandhi 18:6a4db94011d3 62 }
sahilmgandhi 18:6a4db94011d3 63
sahilmgandhi 18:6a4db94011d3 64 int FlashIAP::deinit()
sahilmgandhi 18:6a4db94011d3 65 {
sahilmgandhi 18:6a4db94011d3 66 int ret = 0;
sahilmgandhi 18:6a4db94011d3 67 _mutex->lock();
sahilmgandhi 18:6a4db94011d3 68 if (flash_free(&_flash)) {
sahilmgandhi 18:6a4db94011d3 69 ret = -1;
sahilmgandhi 18:6a4db94011d3 70 }
sahilmgandhi 18:6a4db94011d3 71 _mutex->unlock();
sahilmgandhi 18:6a4db94011d3 72 return ret;
sahilmgandhi 18:6a4db94011d3 73 }
sahilmgandhi 18:6a4db94011d3 74
sahilmgandhi 18:6a4db94011d3 75
sahilmgandhi 18:6a4db94011d3 76 int FlashIAP::read(void *buffer, uint32_t addr, uint32_t size)
sahilmgandhi 18:6a4db94011d3 77 {
sahilmgandhi 18:6a4db94011d3 78 _mutex->lock();
sahilmgandhi 18:6a4db94011d3 79 memcpy(buffer, (const void *)addr, size);
sahilmgandhi 18:6a4db94011d3 80 _mutex->unlock();
sahilmgandhi 18:6a4db94011d3 81 return 0;
sahilmgandhi 18:6a4db94011d3 82 }
sahilmgandhi 18:6a4db94011d3 83
sahilmgandhi 18:6a4db94011d3 84 int FlashIAP::program(const void *buffer, uint32_t addr, uint32_t size)
sahilmgandhi 18:6a4db94011d3 85 {
sahilmgandhi 18:6a4db94011d3 86 uint32_t page_size = get_page_size();
sahilmgandhi 18:6a4db94011d3 87 uint32_t current_sector_size = flash_get_sector_size(&_flash, addr);
sahilmgandhi 18:6a4db94011d3 88 // addr and size should be aligned to page size, and multiple of page size
sahilmgandhi 18:6a4db94011d3 89 // page program should not cross sector boundaries
sahilmgandhi 18:6a4db94011d3 90 if (!is_aligned(addr, page_size) ||
sahilmgandhi 18:6a4db94011d3 91 !is_aligned(size, page_size) ||
sahilmgandhi 18:6a4db94011d3 92 (size < page_size) ||
sahilmgandhi 18:6a4db94011d3 93 (((addr % current_sector_size) + size) > current_sector_size)) {
sahilmgandhi 18:6a4db94011d3 94 return -1;
sahilmgandhi 18:6a4db94011d3 95 }
sahilmgandhi 18:6a4db94011d3 96
sahilmgandhi 18:6a4db94011d3 97 int ret = 0;
sahilmgandhi 18:6a4db94011d3 98 _mutex->lock();
sahilmgandhi 18:6a4db94011d3 99 if (flash_program_page(&_flash, addr, (const uint8_t *)buffer, size)) {
sahilmgandhi 18:6a4db94011d3 100 ret = -1;
sahilmgandhi 18:6a4db94011d3 101 }
sahilmgandhi 18:6a4db94011d3 102 _mutex->unlock();
sahilmgandhi 18:6a4db94011d3 103 return ret;
sahilmgandhi 18:6a4db94011d3 104 }
sahilmgandhi 18:6a4db94011d3 105
sahilmgandhi 18:6a4db94011d3 106 bool FlashIAP::is_aligned_to_sector(uint32_t addr, uint32_t size)
sahilmgandhi 18:6a4db94011d3 107 {
sahilmgandhi 18:6a4db94011d3 108 uint32_t current_sector_size = flash_get_sector_size(&_flash, addr);
sahilmgandhi 18:6a4db94011d3 109 if (!is_aligned(size, current_sector_size) ||
sahilmgandhi 18:6a4db94011d3 110 !is_aligned(addr, current_sector_size)) {
sahilmgandhi 18:6a4db94011d3 111 return false;
sahilmgandhi 18:6a4db94011d3 112 } else {
sahilmgandhi 18:6a4db94011d3 113 return true;
sahilmgandhi 18:6a4db94011d3 114 }
sahilmgandhi 18:6a4db94011d3 115 }
sahilmgandhi 18:6a4db94011d3 116
sahilmgandhi 18:6a4db94011d3 117 int FlashIAP::erase(uint32_t addr, uint32_t size)
sahilmgandhi 18:6a4db94011d3 118 {
sahilmgandhi 18:6a4db94011d3 119 uint32_t current_sector_size = 0UL;
sahilmgandhi 18:6a4db94011d3 120
sahilmgandhi 18:6a4db94011d3 121 if (!is_aligned_to_sector(addr, size)) {
sahilmgandhi 18:6a4db94011d3 122 return -1;
sahilmgandhi 18:6a4db94011d3 123 }
sahilmgandhi 18:6a4db94011d3 124
sahilmgandhi 18:6a4db94011d3 125 int32_t ret = 0;
sahilmgandhi 18:6a4db94011d3 126 _mutex->lock();
sahilmgandhi 18:6a4db94011d3 127 while (size) {
sahilmgandhi 18:6a4db94011d3 128 ret = flash_erase_sector(&_flash, addr);
sahilmgandhi 18:6a4db94011d3 129 if (ret != 0) {
sahilmgandhi 18:6a4db94011d3 130 ret = -1;
sahilmgandhi 18:6a4db94011d3 131 break;
sahilmgandhi 18:6a4db94011d3 132 }
sahilmgandhi 18:6a4db94011d3 133 current_sector_size = flash_get_sector_size(&_flash, addr);
sahilmgandhi 18:6a4db94011d3 134 if (!is_aligned_to_sector(addr, size)) {
sahilmgandhi 18:6a4db94011d3 135 ret = -1;
sahilmgandhi 18:6a4db94011d3 136 break;
sahilmgandhi 18:6a4db94011d3 137 }
sahilmgandhi 18:6a4db94011d3 138 size -= current_sector_size;
sahilmgandhi 18:6a4db94011d3 139 addr += current_sector_size;
sahilmgandhi 18:6a4db94011d3 140 }
sahilmgandhi 18:6a4db94011d3 141 _mutex->unlock();
sahilmgandhi 18:6a4db94011d3 142 return ret;
sahilmgandhi 18:6a4db94011d3 143 }
sahilmgandhi 18:6a4db94011d3 144
sahilmgandhi 18:6a4db94011d3 145 uint32_t FlashIAP::get_page_size() const
sahilmgandhi 18:6a4db94011d3 146 {
sahilmgandhi 18:6a4db94011d3 147 return flash_get_page_size(&_flash);
sahilmgandhi 18:6a4db94011d3 148 }
sahilmgandhi 18:6a4db94011d3 149
sahilmgandhi 18:6a4db94011d3 150 uint32_t FlashIAP::get_sector_size(uint32_t addr) const
sahilmgandhi 18:6a4db94011d3 151 {
sahilmgandhi 18:6a4db94011d3 152 return flash_get_sector_size(&_flash, addr);
sahilmgandhi 18:6a4db94011d3 153 }
sahilmgandhi 18:6a4db94011d3 154
sahilmgandhi 18:6a4db94011d3 155 uint32_t FlashIAP::get_flash_start() const
sahilmgandhi 18:6a4db94011d3 156 {
sahilmgandhi 18:6a4db94011d3 157 return flash_get_start_address(&_flash);
sahilmgandhi 18:6a4db94011d3 158 }
sahilmgandhi 18:6a4db94011d3 159
sahilmgandhi 18:6a4db94011d3 160 uint32_t FlashIAP::get_flash_size() const
sahilmgandhi 18:6a4db94011d3 161 {
sahilmgandhi 18:6a4db94011d3 162 return flash_get_size(&_flash);
sahilmgandhi 18:6a4db94011d3 163 }
sahilmgandhi 18:6a4db94011d3 164
sahilmgandhi 18:6a4db94011d3 165 }
sahilmgandhi 18:6a4db94011d3 166
sahilmgandhi 18:6a4db94011d3 167 #endif